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At  the  end  of  the  week  prior  to  the  planned  final  typing  of  this 
thesis,  a  programming  error  was  discovered  by  the  author  of  the  soft¬ 
ware  which  produced  the  controller  designs  upon  which  much  of  the 
report  is  based.  Investigation  revealed  that  the  design  software  error 
had  an  obvious,  significant  impact  on  some  of  the  results,  observations 
and  conclusions  presented.  Considering  the  limited  time  available,  the 
most  reasonable  option  appeared  to  be  to  document  the  error,  and  to 
explain  its  effects  on  the  results  of  this  study  as  fully  as  possible. 
Thus,  except  for  the  addition  of  Appendix  E  and  the  references  to  it  in 
Chapters  IV,  V  and  VI,  this  report  has  been  left  much  as  it  was  before 
the  error  was  found.  The  theories  and  formulations  presented  are  still 
valid,  as  are  the  logic,  tools  and  methodology  used  to  pursue  the 
design  and  analysis  of  the  controllers.  The  controller  designs 
developed  are  valid  and  do  possess  solid  capabilities  despite  the 
software  error;  they  were  achievable  due  to  the  iterative  nature  of 
modern  optimal  control  design  techniques.  These  iterations  yielded 
controllers  with  gains  that  produced  desirable  performance;  in  using 
the  corrected  software,  different  weighting  matrices  would  be  chosen 
(generally,  as  the  result  of  easier  design  iterations)  to  produce 
essentially  the  same  gains  and  the  same  closed-loop  system  performance. 

While  I  am  disappointed  that  the  accuracy  of  the  data  and  some  of 
the  observations  presented  in  this  report  has  diminished,  I  am  glad 
that  the  discovery  of  the  error  occurred  early  enough  to  allow  it  to  be 
identified  and  its  effects  addressed,  albeit  in  a  limited  sense.  I 
sincerely  hope  that  those  who  may  read  this  thesis  will  still  find  it 


to  contain  useful  information. 
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AFIT/GE/EE/83D-48 


Abstract 


This  study  applies  the  concept  of  implicit  model-following  to  the 


design  of  a  multivariable  control  system  based  on  the  Linear  system 


model.  Quadratic  cost,  and  Gaussian  noise  process  (LQG)  assumptions  of 


optimal  control.  The  design  objective  is  to  achieve  improved 


r'  y 

controller  robustness  in  the  face  of  '"uncertainties"  arising  from  the 


differences  between  the  simplified  linear  model  used  for  controller 
design,  and  a  more  realistic  truth  model  representation  which  includes 
higher-order  dynamics,  parameter  variations,  and  nonlinearities. 

This  report  introduces  the  concept  of  implicit  model-following  and 
reviews  the  formulation  of  its  incorporation  into  the  design  of  a 
controller  that  consists  of  a  Command  Generator  Tracker  (CGT)  employing 
a  Proportional-plus-integral  (PI)  inner-loop  regulator  and,  if 
required,  a  Kalman  Filter  (KF)  to  provide  state  estimates  for  feedback 
control  (CGT/PI/KF  controller). 

The  theoretical  background  for  the  application  of  matrix  singular 
value  analysis  to  the  study  of  controller  robustness  is  presented,  and 
a  computer  program  is  developed  to  apply  this  type  of  analysis  to  the 
general  CGT/PI/KF  controller  configuration.  Additional  software  is 


developed  to  analyze  the  performance  of  theXspecific  designs  achieved 


ie\si 


in  this  study  by  means  of  conventional  simulation  with  respect  to 


various  realistic  truth  models.  Both  programs  ^~e  documented  and 


\ 


listed  in  this  report.  \ 

A  variety  of  deterministic  CGT/PI  controllers  for  the  decoupled, 


pitch-pointing  control  of  a  modern  fighter  aircraft  (the  AFTI  F— 16)  are 
designed  through  the  use  of  software  developed  in  the  course  of 
previous  AFIT  thesis  efforts.  These  controller  designs  are  analyzed 
extensively  through  the  use  of  the  software  developed  in  this  study. 

The  incorporation  of  implicit  model-following  in  the  design  process  for 
the  inner-loop  regulator  is  shown  to  provide  an  enhanced  capability  to 
produce  designs  which  work  well  despite  unmodelled  dynamics  and  system 
nonlinearities  (specifically,  control  actuator  saturation),  when 
compared  to  design  methods  which  do  not  use  implicit  models. 

The  results  of  the  singular  value  and  simulation  analyses  are 
combined  and  contrasted.  The  type  of  singular  value  analysis  employed 
in  this  study  is  shown,  for  the  design  problem  considered,  to  be  of 
limited  value  in  predicting  the  robustness  of  controller  performance. 
Classical  analysis  based  on  the  locations  of  nominal  closed-loop 
controller  poles  is  shown  to  provide  considerable  insight  and 
predictive  capability  for  robustness  in  the  face  of  higher-order 


dynamics 


ROBUST  MULTIVARIABLE  CONTROLLER  DESIGN 


VIA  IMPLICIT  MODEL-FOLLOWING  METHODS 


I.  Introduction 


1 .1  Background 

An  important  objective  in  control  system  design  is  to  meet 
constraints  on  both  the  transient  and  the  steady-state  behavior  of  a 
physical  system.  Achieving  these  objectives  generally  requires  the  use 
of  some  form  of  feedback  control,  which  provides  the  designer  with  an 
even  more  critical  concern  —  that  the  closed-loop  system  be  stable  at 
all  times  and  under  all  operational  conditions.  Design  of  systems  that 
meet  these  criteria  is  greatly  complicated  by  unknown  or  unmodelled 
differences  between  the  mathematical  model  on  the  drawing  board  and  the 
real  world.  These  include  (1)  disturbances  that  affect  the  controlled 
system  (plant)  and  sensors,  (2)  order  reduction  in  the  design  model 
required  to  simplify  the  design  or  controller  implementation, 

(3)  unmodelled  or  ignored  nonlinearities,  and  (4)  parameter  variations 
between  the  actual  system  and  an  otherwise  adequate  design  model 
representation.  The  effects  of  these  "uncertainties"  can  cause  serious 
performance  degradation  or  instability  if  the  designer  does  not  allow 
for  their  existence.  The  term  "robustness"  is  used  to  define  the 
amount  of  design  uncertainty  that  can  be  tolerated,  or  the  amount  by 
which  the  real  world  can  vary  from  the  nominal  design  model,  without 
destabilizing  the  actual  physical  closed-loop  control  system  or  causing 
it  to  fail  to  meet  performance  specifications  [4,11,13,30,41].  In  this 


thesis  "robustness"  will  be  primarily  used  in  reference  to  the 
stability  consideration;  when  "performance  robustness"  is  intended,  it 
will  be  specified  explicitly. 

The  stability  robustness  of  single-input,  single-output  (SISO) 
control  system  designs  is  frequently  characterized  using  the  well  known 
concepts  of  gain  and  phase  margins,  although  these  measures  do  not  take 
into  account  the  effects  of  simultaneous  gain  and  phase  changes  that 
could  produce  instability  [30,431.  Even  these  limited  measures  have  no 
direct  counterparts  that  can  be  applied  to  the  case  of  multiple-input, 
multiple-output  (MIMO)  control  systems.  Attempts  to  analyze  the 
robustness  of  MIMO  designs  one  loop  at  a  time  using  the  SISO  analysis 
methods  generally  provide  overly  optimistic  robustness  estimates  in 
that  they  fail  to  identify  the  effects  of  simultaneous  variations  in 
interrelated  system  loops  [11,12,14,41].  Since  many  of  the  flight 
control  and  weapons  system  developments  currently  of  interest  to  the 
Air  Force  depend  on  multi-loop  designs,  the  lack  of  adequate  design  and 
analysis  tools  has  a  serious  impact.  A  means  of  quantifying  the 
robustness  of  MIMO  designs  is  a  necessary  prerequisite  for  developing 
more  certain  methods  of  synthesizing  control  systems  that  are,  in  fact, 
robust.  Singular  value  analysis  of  the  matrices  which  are  used  to 
describe  the  control  system  has  been  shown  to  provide  such  a  capability 
[4,7,11,12,14,15,18,24,27,30,35,37,38,41],  and  it  will  be  described  in 
some  detail  and  used  in  this  thesis. 

One  approach  to  modern  multi-loop  control  system  design  involves 
the  assumption  of  a  linear  system  with  disturbances  and  measurement 
corruptions  which  can  be  represented  as  Gaussian  processes,  and  with 
control  laws  based  on  the  mathematical  optimization  of  a  scalar 


quadratic  cost  function  (performance  index).  Such  LQG 
(Linear-Quadratic-Gaussian)  design  techniques  can  be  applied  to  many 
types  of  complex  problems,  generating  designs  with  many  desirable 
characteristics.  These  techniques  do  not,  however,  directly  address 
the  robustness  issue,  and  many  designs  based  on  LQG  assumptions  and 
methods  have  demonstrated  a  serious  lack  of  robustness;  the  presence  of 
an  observer  or  filter  in  the  control  loop  is  a  primary  cause  of  the 
problem  [10,30].  Robustness  analysis  is  therefore  imperative  for  the 
LQG  designer. 

One  controller  configuration  in  the  LQG  class  consists  of  a 
Command  Generator  Tracker  (CGT)  which  provides  feedforward  control,  a 
Proportional-plus-integral  (PI)  inner-loop  controller  designed  by  LQ 
deterministic  optimal  control  methods,  and  a  Kalman  Filter  (KF)  to 
provide  state  estimates  necesssary  for  control  law  generation  (as  a 
unit,  henceforth  referred  to  as  CGT/PI/KF)  [16,31,34].  The  CGT/PI/KF 
controller  was  the  subject  of  two  recent  AFIT  thesis  efforts  by  Capt  R. 
M.  Floyd  and  Lt  A.  Moseley  [16,34].  These  studies  included  the 
development  of  interactive  computer  software  for  efficient  design  and 
performance  analysis  of  the  CGT/PI/KF  controller.  A  unique  aspect  of 
this  type  of  controller  is  the  use  of  "model-following"  to  force  the 
controlled  plant  to  respond  in  a  way  which  mimics  the  response  of  an 
ideal  system.  This  can  be  done  by  means  of  the  feedforward  controls  of 
the  CGT  ("explicit"  model-following),  or  by  changing  the  control 
system’s  closed-loop  characteristics  by  incorporating  a  model  of  an 
ideal  response  into  the  regulator's  performance  index  ("implicit" 
model-following),  or  both.  The  complexity  of  this  configuration  makes 
robustness  analysis  somewhat  difficult.  At  the  same  time,  the  degrees 
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of  design  freedom  created  by  this  compexity  make  the  CGT/PI/KF  a 
promising  vehicle  for  investigating  means  of  robustess  enhancement, 
especially  through  the  use  of  implicit  model-following.  Refer  to 
Chapter  II  for  a  more  detailed  discussion  of  model-following  control 
and,  in  particular,  the  structure  and  design  methods  for  the  CGT/PI/KF 
controller. 


1 .2  Recent  Research 

In  general,  the  scalar  parameters  that  describe  a  SISO  control 
system  are  replaced  by  matrix  quantities  in  the  MIMO  case.  The 
open-loop  transfer  function  becomes  a  loop  gain  matrix,  and  the  return 
difference  function  (the  denominator  of  the  control  ratio)  is  replaced 
by  a  corresponding  return  difference  matrix  function.  Analysis  of 
functions  of  these  matrix  quantities  can  provide  much  insight  into  the 
performance  and  stability  robustness  of  complicated  systems,  just  as 
scalar  analysis  does  in  the  SISO  case  [11,14,30,37,41].  Many  of  the 
classical  "rules  of  thumb"  that  have  traditionally  been  applied  to  the 
loop  gains  of  SISO  control  systems  can  be  generalized  to  apply  to  the 
"singular  values"  of  the  MIMO  loop  matrix  [14,37,43].  Similarly,  the 
use  of  the  matrix  singular  value  decomposition  provides  insight  into 
the  "size"  of  the  system's  return  difference  matrix;  this  quantity  and 
the  associated  inverse  return  difference  matrix  are  directly  related  to 
the  system's  overall  stability  [11,14,30,47,43]. 

Matrix  singular  value  analysis  (discussed  at  length  in  Chapter 
III)  has  generated  a  great  deal  of  research  in  the  last  few  years 
[4,7,11,12,14,15,18,24,27,30,35,37,38,41].  A  very  good  basic 
discussion  of  the  impact  and  application  of  singular  value  analysis  in 
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assessing  stability  robustness  was  presented  by  Doyle  [11].  Expansion 
of  these  concepts  to  the  more  general  analysis  of  both  stability 
robustness  and  performance  using  singular  value  analysis  of  several 
system  matrices  was  given  by  Doyle  and  Stein  [14];  this  work  provided 
some  pleasing  generalizations  of  many  classical  SISO  design  tools  to 
the  MIMO  case.  In  both  of  these  sources,  the  robustness  analyses  are 
based  on  the  effects  of  a  very  general  class  of  perturbations  to  the 
design  model  parameters  referred  to  as  "unstructured"  uncertainties. 
Since  a  subset  of  this  class  generally  represents  perturbations  that 
could  never  physically  occur,  robustness  estimates  are  often  overly 
conservative.  More  recent  research  [12,18,27,40]  has  centered  on 
analysis  that  takes  into  account  knowledge  of  what  perturbations  are 
physically,  possible  and  which  will  have  the  greatest  effect  on 
robustness  and  performance.  This  work  with  "structured"  uncertainty 
leads  to  tighter  bounds  on  robustness  estimates. 

Robustness  analysis  is  necessary  to  ensure  that  a  control  system 
will  remain  stable  in  the  face  of  uncertainties.  If  such  analysis 
uncovers  design  deficiencies,  then  steps  must  be  taken  to  robustify  the 
system.  Gilbert  [19]  has  shown  that  if  the  eigenvectors  of  the 
closed-loop  system  are  made  as  nearly  orthogonal  as  possible,  improve¬ 
ment  in  robustness  results;  design  methods  involving  eigenstructure 
assignment  therefore  have  the  potential  for  robustness  enhancement 
[1,20,25].  Because  it  depends  on  an  internal  model  of  the  overall 
system  to  provide  estimates,  insertion  of  a  Kalman  filter  in  the  loop 
generally  degrades  robustness  [10,30].  Doyle  and  Stein  [13]  have 
shown  a  means  of  recovering  some  of  this  lost  robustness  by  systemat¬ 
ically  injecting  pseudonoise  into  the  filter  model  at  the  control  input 


points;  a  dual  approach  involves  a  structured  change  in  the  quadratic 
state  weightings  used  in  the  controller  design  [14,26,433.  The  first 
of  these  methods  was  employed  in  an  AFIT  thesis  by  Capt  E.  D.  Lloyd 
[28]  with  some  success.  Except  for  the  methods  cited,  much  of  the 
design  robustification  that  occurs  must  still  be  based  on  iterative 
methods,  using  insight  gained  from  such  tools  as  singular  value 
analysis  and  simulation  of  actual  system  performance. 

1 .3  Objective 

The  purpose  of  this  study  was  to  attempt  to  develop  synthesis 
techniques  for  the  design  of  robust  LQG  controllers.  In  particular,  an 
effort  was  to  be  made  to  develop  the  use  of  implicit  model-following  as 
a  means  of  enhancing  controller  robustness  in  the  face  of  a  variety  of 
uncertainties.  The  software  developed  by  Floyd  and  Moseley  was  to  be 
used  to  conduct  the  design  and  initial  evaluation  of  CGT/PI  control¬ 
lers.  A  computer  program  was  to  be  developed  to  calculate  and  plot  the 
singular  values  of  the  loop  gain  and  inverse  return  difference  matrices 
of  a  control  system  in  the  CGT/PI/KF  configuration,  as  a  function  of 
frequency.  An  inequality  (discussed  in  Chapter  III)  relating  the 
singular  values  of  the  inverse  -return  difference  matrix  and  the  maximum 
stable  perturbation  to  the  design  model  was  to  be  used  as  one  measure 
of  stability  robustness.  Additional  software  was  to  be  written  to 
conduct  performance  analysis  of  the  controllers  operating  on  nonlinear 
truth  models,  models  with  higher-order  dynamics,  models  with  parameter 
variations,  and  combinations  of  such  perturbations  to  the  design  model. 
The  results  of  singular  value  and  simulation  analyses  were  to  be 
compared  and  combined.  Methods  of  improving  the  robustness  of  the 
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control  system,  primarily  with  implicit  model-following,  without 
excessively  or  unnecessarily  degrading  performance  were  to  be 
investigated. 

1.4  Sequence  of  Presentation 

Chapter  II  presents  a  more  detailed  look  at  the  structure  and 
design  of  the  CGT/PI/KF  controller,  as  well  as  the  concept  of 
model-following.  Chapter  III  outlines  the  development  of  the 
robustness  analysis  and  enhancement  methods  that  were  to  be  employed. 
Chapter  IV  presents  specific  design  models  and  objectives,  the  approach 
to  be  taken  in  conducting  the  controller  design  and  analysis,  and  a 
summary  of  general  observations  that  emerged  during  the  study 
concerning  the  use  of  implicit  model-following  in  regulator  design. 
Chapter  V  discusses  the  specific  results  of  the  design  efforts 
conducted,  and  Chapter  VI  offers  some  conclusions  and  recommendations 
for  further  study.  Appendix  A  contains  a  brief  review  of  the  LQG 
problem  formulation  and  solution,  while  Appendices  B,  C  and  D  document 
the  software  developed  and/or  used  in  this  study.  Appendix  E  documents 
an  error  that  was  discovered  in  the  CGT/PI/KF  design  software  after  the 
design  work  of  this  research  had  been  completed.  The  error  and  its 
significance  with  respect  to  the  results  and  conclusions  presented 
herein  are  outlined,  and  some  preliminary  designs  using  the  corrected 
software  are  presented.  The  reader  is  urged  to  review  Sections  E.1 
through  E.3  prior  to  any  detailed  study  of  Chapters  IV,  V  or  VI. 


1 .5  Notation 


An  attempt  has  been  made  to  adhere  to  the  notation  used  by  Maybeck 
[29-31]  and  the  AFIT  theses  by  Floyd  and  Moseley  C 1 6 , 3M ] .  Appendix  A 
contains  a  brief  review  of  the  LQG  controller  problem  formulation  and 
solution;  this  includes  an  introduction  to  the  notation  as  well  as  the 
concepts  represented.  This  review  includes  the  majority  of  the  basic 
notation  that  is  used  throughout  the  thesis,  and  additional  notation  is 
defined  as  it  is  introduced. 


II.  Model-Following  and  The  CGT/PI/KF  Controller 

2. 1  Introduction 

This  chapter  discusses  the  concept  of  model-following  control  in 
LQG  designs.  The  CGT/PI/KF  controller  configuration  is  described 
[5,30],  along  with  an  outline  of  a  design  procedure  as  implemented  in 
software  developed  by  Floyd  and  Moseley  [16,34].  The  level  of  detail 
in  this  description  is  intended  to  be  sufficient  for  the  reader 
interested  primarily  in  understanding  the  purpose  and  results  of  the 
study  described  in  this  thesis.  While  much  of  the  theory  discussed  is 
applicable  to  a  wide  range  of  problems,  the  analysis  software  developed 
in  this  study  is  useful  only  for  designs  based  on  the  formulations  of, 
and  conducted  using  the  software  of,  the  previous  thesis  efforts.  For 
that  reason,  a  reader  interested  in  using  the  specific  tools  developed 
herein  is  referred  to  the  Floyd  and  Moseley  works  for  a  more  complete 
development  and  description  of  related  design  software  and  methodology. 

2.2  Model-Following  Controllers 

The  development  in  Appendix  A  demonstrates  that  the  LQG  design 

approach  provides  a  systematic  means  of  synthesizing  control  laws  for 
complex,  multi-loop  systems.  Despite  the  capabilities  inherent  in 
methods  based  on  optimal  estimation  and  control  theory,  classical 
control  design  and  analysis  methods  remain  the  primary  tools  of  most 
design  engineers  [16,31,43].  One  of  the  reasons  for  the  failure  of 
modern  tools  to  replace  the  classical  is  the  fact  that  many  design 
specifications  are  stated  in  terms  of  time-domain  input/output  behavior 
—  settling  time,  peak  overshoot,  damping  ratio,  steady-state  error  and 


disturbance  rejection  characteristics  —  which  are  not  readily 
translated  into  quadratic  weightings  to  be  used  in  a  performance  index. 
The  result  is  a  considerable  amount  of  trial-and-error-based  design 
iteration,  often  without  a  great  deal  of  physical  insight. 

The  concept  of  model-following  first  arose  in  the  1960's  as  a 
means  of  implementing  modern  control  techniques,  and  has  proven 
particularly  useful  in  aircraft  control  system  designs  where  specifica¬ 
tions  consist  of  desired  "handling  qualities"  expressed  in  terms  of 
classical  time-domain  criteria  [16].  Model-following  provides  a  means 
of  forcing  the  outputs  of  a  controlled  system  to  behave  as  if  they  were 
those  of  a  model  system  which  is  known  to  have  the  desired  qualities. 
Typically,  the  objective  is  to  cause  a  complex,  high-order  system  to 
match  the  characteristics  of  a  simpler  model,  achieving  an 
approximation  of  a  first-  or  second-order  output  response  that  meets 
specifications.  Another  use  of  model-following  is  in  causing  one 
system  to  mimic  the  response  characteristics  of  another  system,  such  as 
one  aircraft  that  exhibits  the  same  handling  qualities  as  another  [16]. 

Within  the  model-following  class  of  controllers  are  two  subgroups: 
implicit  and  explicit  model-following  controllers.  In  implicit 
model-following,  the  description  of  the  "model"  system  is  incorporated 
into  the  performance  index;  feedback  control  is  thus  designed  to 
penalize  the  system  mathematically  for  deviations  from  model  perfor¬ 
mance.  In  explicit  model-following,  the  desired  response  dynamics  are 
simulated  in  the  controller  and  used  to  generate  commands  consisting  of 
feedforward  gains  on  model  controls  and  states.  The  feedforward 
control,  generally  used  in  conjunction  with  feedback  control  from  some 
form  of  inner-loop  regulator,  thus  optimally  drives  the  system  to 


achieve  model  response.  Development  of  both  concepts  is  quite 
straightforward  [6,1 6,3**  3. 


A  very  simple  example  formulation  follows,  which  demonstrates  how 
model-following  works.  The  fact  that  this  is  an  example  formulation 
cannot  be  overemphasized.  There  are  similarities  between  the 
controllers  discussed  in  this  section  and  those  actually  used  in  this 
study,  but  there  are  important  differences  as  well.  To  avoid  confusion 
that  could  result  from  incorrectly  relating  this  simple  example 


formulation  to  that  of  the  PI  regulator  developed  in  Appendix  A  and  the 
CGT/PI  development  of  Section  2.3,  distinct  notation  is  used  for  the 
weighting  matrices  of  the  cost  functions  in  this  section.  Reference  to 


the  equations  of  this  section  is  avoided  throughout  the  rest  of  the 
thesis,  except  in  Appendix  A,  where  the  correct  relationship  between 


the  different  formulations  is  discussed. 

Consider  the  linear-quadratic  full-state  feedback  (LQSF) 
regulation  problem  for  the  continuous-time  system  described  by  the 
state  differential  equation 


x(t)  s  Ax(t)  +  Bu(t) 


While  it  is  possible  to  include  non-zero  command  inputs  in  the 


(II-1) 


formulation,  the  result  would  be  much  more  complicated;  in  this  simple 
example,  only  response  to  initial  conditions  is  considered.  The 
desired  control  law  is  of  the  form 


u(t)  a  -  G  (t)x(t) 


(II-2) 


A  steady-state,  constant  gain,  G  ,  is  often  sought  for  practical 


implementation.  The  objective  is  to  force  the  output  of  the  system 
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y(t)  =  Cx(t) 


(II-3) 


to  match  as  closely  as  possible  the  output  of  a  model  system,  described 
by  the  equation 


Lit)  =  A  y  (t) 
—®  mT  m 
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where  ^  is  of  the  same  dimension  as  £.  At  this  point,  the  use  of  time 
arguments  will  be  dropped  to  simplify  the  notation.  The  appropriate 
scalar  performance  index  to  be  minimized  in  determining  the  optimal 
feedback  control  law  is 


Jx  =  1  /2  f  [(y  -  -  A^)  +  u^jUDdt 
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where 
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and  the  function  is  integrated  over  all  time  so  as  to  define  a 
steady-state,  constant-gain  controller. 

A 

The  cross-weighting  term,  appears  in  the  index  due  to  the  need 
to  track  rates  of  change  in  the  output.  The  form  of  the  performance 
index  shown  thus  allows  the  use  of  standard  LQ  synthesis  techniques  to 
develop  an  optimal  feedback  controller  that  tries  to  force  the  system 
to  meet  classical  performance  specifications  embodied  in  the  model 


output,  The  extent  to  which  the  desired  response  is  achievable  is 

dependent  on  the  degree  of  difference  between  the  system's  inherent 


dynamics,  represented  by  A,  and  the  desired  response  dynamics, 

represented  by  A  . 

“in 

In  developing,  again  as  a  very  simple  example  formulation,  an 
explicit  model-following  controller  for  the  same  system,  an  appropriate 
performance  index  might  be  of  the  form 


je  =  1/2/  t<i  -4)Vi  -V  ♦uT«BuJdt 
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In  order  to  achieve  a  "standard"  index  [6,30],  define 


<  =  c*Tj,T  ]T 
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so  that 
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and  thus. 


JE  *  *  u^idt 
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where 
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Since  the  resulting  control  law  is  of  the  form 


u  :  •  G  a  s  .  G  ,x  -  G  .y 


(11-11) 


(11-12) 


the  model  output  must  be  simulated  in  order  to  generate  the  required 
feedforward  control. 

A  very  general  structural  diagram  of  such  an  explicit 
model-follower  is  shown  in  Figure  II-1 .  The  value  of  _G^  is 
independent  of  the  form  of  the  explicit  model  to  be  followed  and,  for 
this  simple  example,  is  the  gain  determined  by  solution  of  the  optimal 
regulator  problem  for  the  controlled  system. 


Figure  II-1.  Explicit  Model-Follower,  with  Simple 
Feedback  Regulator  [6] 

If  the  controlled  system  could  be  perfectly  modelled  and  operated 
under  ideal  conditions  without  any  unmodelled  disturbances,  then 
performance  specifications  could  be  met  with  either  implicit  or 
explicit  model-following.  Under  more  realistic  conditions,  the  two 
types  of  controllers  have  some  important  differences  [16]. 

The  implicit  formulation  has  an  effect  that  is  asymptotically  (as 
state  weightings  grow  large)  equivalent  to  eigenstructure  assignment 


[25],  and  the  matching  of  the  poles  of  the  model  and  controlled  system 
can  produce  desirable  transient  response.  Rejection  of  unmodelled 
zero-mean  disturbances  may  also  be  better  than  with  an  explicit 
controller,  since  good  disturbance  rejection  characteristics  can  be 
included  in  the  model  response  so  that  the  disturbance  states  need  not 
be  modelled  in  the  controller.  However,  since  the  feedback  gain  is 
directly  a  function  of  (A  -  A  ),  the  implicit  model-follower  is 
particularly  sensitive  to  parameter  variations  and  plant  modelling 
inaccuracies. 

The  explicit  model-follower  is  the  more  complex  formulation. 

Since  the  model  dynamics  must  be  simulated  by  the  controller  (which 
causes  a  time  lag),  and  because  no  attempt  is  made  to  match  the 
closed-loop  poles  of  the  system  to  the  poles  of  the  performance  model, 
a  higher  feedback  gain  is  generally  required  than  that  of  the  implicit 
model-follower  in  order  to  achieve  comparable  transient  response. 

Since  the  actual  outputs  are  compared  instead  of  rates  of  change, 
steady-state  operation,  rejection  of  constant  disturbances,  and 
sensitivity  of  steady-state  output  response  to  parameter  variations  is 
generally  better  with  explicit  model-following  [16,25]. 

The  advantages  of  both  model-following  formulations  may  be 
achieved  by  combining  the  two,  resulting  in  additional  flexibility  and 
degrees  of  design  freedom,  as  well  as  a  more  complicated  design 
procedure.  The  performance  index  for  such  a  design  would  be  a  linear 
combination  of  the  indices  for  the  implicit  and  explicit 
model-followers,  such  as: 


(11-13) 


Y‘J 

r.-N 


Jc  -  1/2  f  [ (y  -iy) 

Jq 

+(y  -  y  )TJp(y  -  y  )  +  uTuu]dt 

A  design  method  based  on  using  the  performance  index  of  (11-13)  would 
provide  the  designer  the  capability  of  optimizing  the  mix  of  desirable 
characteristics  of  the  two  types  of  model-followers  by  adjusting  the 
relative  values  of  Y^  and  Y^,  including  setting  either  one  to  zero. 

When  command  inputs  to  the  system  are  allowed,  both  implicit  and 
explicit  model-following  formulations  would  require  that  the  command 
input  and  outputs  be  modelled  so  that  appropriate  feedforward  controls 
could  be  generated  to  drive  the  system  outputs  to  the  appropriate 
non-zero  steady -state  values.  The  implicit  model-follower  would  then 
also  require  the  use  of  feedforward  control,  as  was  originally  the  case 
only  with  the  explicit  controller.  In  combined  implicit/explicit 
model-following,  the  feedforward  controls  are  dictated  jointly  by  the 
implicit  and  explicit  performance  index  terms,  but  the  feedback 
controls  are  affected  only  by  the  implicit  model-following  control 
which  attempts  to  match  the  system's  closed-loop  poles  with  those  of 
the  model.  Thus  the  use  of  implicit  model-following  is  closely  tied  to 
the  closed-loop  system  characteristics,  including  stability  robustness. 
Feedforward  control,  and  thus  the  use  of  explicit  model-following,  will 
have  no  effect  on  the  closed-loop  stability  robustness  of  a  linear 
system. 
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2.3  The  CGT/PI/KF  Controller 


The  controller  of  interest  in  this  study  consists  of  a  Command 
Generator  Tracker  (CGT),  which  produces  the  required  feedforward 
controls  to  attempt  to  cause  the  system  to  track  a  model  trajectory  in 
response  to  command  inputs,  and  a  Proportional-plus-integral  (PI) 
inner-loop  feedback  controller  to  provide  regulation  and  closed-loop 
stability.  With  full-state  feedback,  this  configuration  will  be 
referred  to  as  CGT/PI;  a  Kalman  Filter  (KF)  may  be  added  to  provide  the 
required  state  estimates,  thus  producing  the  CGT/PI/KF  controller.  In 
order  to  achieve  a  tractable  implementation,  both  the  controller  and 
the  filter  often  employ  constant  gains,  and  such  was  the  case  in  this 
study.  The  benefits  of  the  reduced  computational  burden  are  assumed  to 
outweigh  any  degradation  that  would  result  from  using  the  constant-gain 
approximation.  A  block  diagram  of  the  CGT/PI/KF  controller  is  shown  in 
Figure  II-2. 

This  configuration  provides  a  great  deal  of  design  flexibility. 

The  CGT  is  an  explicit  model-follower;  the  command  model  used  is  the 


ideal  performance  model,  and  the  CGT  may  also  contain  models  of 
disturbances  that  the  system  is  to  reject.  The  PI  controller  may  be 
designed  simply  to  provide  optimal  "type  1"  feedback  characteristics. 


including  rejection  of  unknown  disturbances  and  good  transient  and 
steady -state  characteristics.  The  development  of  this  type  of 
"standard"  PI  regulator  is  outlined  in  Appendix  A.  The  PI  regulator 


may  also  provide  implicit  model-following  characteristics  by  inclusion 
of  an  implicit  model  in  the  performance  index.  The  Kalman  filter 
provides  state  estimates  needed  by  the  PI  controller  as  well  as 


estimates  of  modelled  disturbances  for  use  by  the  CGT  in  generating 


optimal  feedforward  control 
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Figure  II-2.  The  CGT/PI/KF  Controller  [31]. 

The  CGT/PI/KF  controller  was  the  subject  of  recent  AFIT  theses  by 
R.  M.  Floyd  and  A.  Moseley  [16,3^]»  The  results  of  those  efforts 
included  interactive  computer  software  for  the  design  and  performance 
evaluation  of  CGT/PI/KF  controllers.  The  referenced  works  provide 
complete  detail  on  the  development  of  the  design  and  evaluation 
procedure  as  well  as  guides  for  using  the  software,  and  are  highly 
recommended  reading.  A  review  of  the  basic  structure  of  the  controller 
and  the  models  used  in. its  design  using  the  aforementioned  software 
follows . 

The  design  of  the  CGT/PI  or  CGT/PI/KF  requires  the  definition  of 
several  different  linear  models.  The  designer  defines  each  of  these  as 


a  continuous-time  model.  The  computer  program  then  converts  each  of 
the  models  to  an  equivalent  discrete-time  form  [16,29»30]  for  use  in 
developing  the  discrete-time  digital  controller.  The  design  and  truth 
models  are  mathematical  representations  of  the  system  to  be  controlled, 
and  are  identical  in  form.  The  truth  model,  at  least  in  theory, 
embodies  all  that  the  designer  knows  about  the  system,  and  is  used  only 
to  evaluate  the  performance  of  the  controller.  The  design  model  is  a 
purposefully  simplified  version  which  describes  the  system  well  enough 
to  become  the  basis  for  a  computationally  tractable  control  law. 

Hence,  the  design  model  is  used  in  the  synthesis  of  the  controller,  and 
the  truth  model  is  "connected"  to  the  controller  for  subsequent 
performance  evaluation.  The  design  model  used  internally  by  the 
CGT/PI/KF  design  software,  then,  consists  of  a  linear  time-invariant 
discrete-time  stochastic  vector  model  of  the  form 

x(ti+l)  =  +-xd-2d^ti^  *  (11-14) 

y (t  )  =  Cx(t  )  +  D  u ( t .  )  +  E  n,(t, )  (11-15) 

where  x(t^)  is  the  system  state  at  the  sample  time  t^,  u(t^)  is  the 

control  applied  to  the  system  at  time  t^  and  held  constant  until  time 

t.^.,  n.(t. )  represents  the  time-correlated  disturbances  affecting  the 
1+1  -a  i 

system,  w,(t. )  is  a  zero-mean,  discrete-time  white  Gaussian  driving 
~ d.  1 

noise  of  covariance  Q^,  and  £(t^)  is  the  output  vector  over  which 
control  is  to  be  exercised.  Such  a  model  could,  in  general,  represent 
an  actual  discrete  process,  but  in  this  case  is  an  equivalent 
discrete-time  description  of  an  underlying  continuous-time  process 
[16,30],  assuming  the  nonsingularity  of  $.  If  the  actual  system  is 


nonlinear,  the  model  may  represent  linearized  perturbation  states,  as 
in  the  case  of  aircraft  equations  expanded  about  a  trim  condition. 


The  time-correlated  disturbance  vector  may  be  generated  as  the 
output  of  a  time-invariant  linear  shaping  filter: 


Ai(ti+1)  = 


Vd(V  +  *nd(ti) 


(11-16) 


with  w  ,  (t, )  a  zero-mean  white  Gaussian  noise  of  covariance 
— nd.  l 

independent  of  w,(tl  in  (11-14). 

— u  1 

The  model  for  the  system's  desired  dynamic  response,  used  for 
explicit  model-following,  is  called  the  command  generator  model: 


that  is 


VW 

4(tl> 


4>  x  ( t,  )  +  B  .u  (t,  ) 
-nun  1  - md— m  i 


C  x  (t,  )  ♦  Du  (t.  ) 
— m— m  l  — m— m  l 


(11-17) 

(11-18) 


With  Floyd  and  Moseley's  software,  the  command  generator  model  is  also 

used  as  the  performance  model  for  implicit  model-following;  however,  it 

is  possible  to  use  different  model  definitions  for  the  two  design 

functions.  In  fact,  such  a  generalization  was  employed  in  this 

research.  The  model  control,  u  (t. ),  is  the  actual  command  input  to 

-m  i 

the  controller,  as  from  the  pilot  stick,  and  is  assumed  to  vary  slowly 
with  time  compared  to  the  controller  sampling  period;  with  the  sampling 
rates  used  in  modern  digital  controllers,  u^t^)  may  be  considered  to 
be  piecewise  constant  for  the  purpose  of  control  law  derivation  [30]. 

In  the  design  implementation  developed  by  Floyd  and  Moseley 
[16,34],  the  use  of  explicit  model-following  requires  that  the 
dimension  of  ^  be  the  same  as  that  of  £;  the  use  of  implicit 
model-following  requires  that  the  dimension  of  £  be  the  same  as  that  of 


x_.  The  only  other  dimensionality  restriction  is  that  the  number  of 

-fli 

control  inputs  equal  the  number  of  controlled  outputs.  Designs  may  be 
conducted  which  actually  violate  the  last  restriction  by  simply 
introducing  a  "dummy"  input  or  output.  A  true  solution  is  possible 
only  when  the  number  of  controls  equals  or  exceeds  the  number  of 
inputs;  an  approximation  based  on  a  matrix  pseudoinverse  results 
otherwise  [16,30]. 

Optimal  controller  designs  based  on  the  LQG  assumptions  are  said 
to  possess  the  property  of  certainty  equivalence  [30].  Because  of  this 
property,  the  optimal  stochastic  controller  for  such  a  design  consists 
of  an  optimal  linear  Kalman  filter  cascaded  with  a  deterministic 
optimal  linear  controller,  and  the  design  of  the  filter  and  of  the 
controller  can  be  conducted  separately  [30].  Certainty  equivalence  is 
invoked  at  this  point  in  the  CGT/PI/KF  development;  the  design  of  the 
deterministic  CGT/PI  follows. 

In  the  deterministic  open-loop  formulation,  the  CGT  must  force  the 
error  between  the  model  output  and  the  system  output  to  be  zero: 

eCtj,)  .^(t^)  =  0  (11-19) 

Ideal  state  and  control  trajectories  can  be  defined  as  the  time 
histories  of  system  states  and  controls  that  must  be  followed  to 
accomplish  this  objective.  First,  the  ideal  trajectory  must  obey  the 
basic  state  model  relationships  of  (11-14),  or,  in  a  deterministic 
setting, 

Wi)  =  s  W  +4dAi(ti)  (II-20) 

If  the  ideal  trajectories  are  constrained  to  be  linear  combinations  of 


x  (t. ),  u  (t. ),  and  n,(t, ),  i.e., 
-in  l  — m  1  — d  I 


il'V' 


A1  _  x  ( t  ) 

—13  -m  i 


43  J  W 
W 


(II-21) 


then  the  CGT  solution  is  achieved  by  solving  for  the  constant  matrix 
partitions  in  (11-21)  such  that  (11-19)  and  (11-20)  are  also  satisfied. 
Defining  a  II  matrix  as 


on  ni2i  r*  - 1  4 

Q21  022  -  -y 


it  can  be  shown  [30]  that  the  solution  is 


-11  s  -11-11  ($n  “  +  0l2-m 

—12  a  -ll-ll4id  +  Sl2-Aii 

-13  ’  -11-13  (^n  "  -}  "  %1-xd  ’  — 12— y 

-21  =  321-11  (^n  ”  +  322-^1 

—22  =  321-^1  Ad  +  322-Sm 

*23  *  321-^13  (^n  ”  I5  “  321-xd”  P22 % 


(II-23a) 

(II-23b) 

(11-230 

(II-23d) 

(11-230 

(II-23f) 


and  methods  have  been  developed  C 3 * 23 3  to  solve  these  efficiently.  The 


ideal  constant-gain  feedforward  control  is  therefore  a  linear 
combination  of  the  command  generator  model  states,  the  command 
generator  model  (command)  input  vector,  and  the  disturbance  states 
[16,30,343.  Once  (11-23)  is  solved,  the  lower  partition  of  (11-21) 

11-14 


yields  ^(t^)  as 


W  '.felW  *  -fezW  *  *23^(ti: 


(11-24) 


When  a  deterministic,  constant-gain  PI  controller,  as  developed  in 
Appendix  A,  is  included  to  provide  feedback  control,  the  control  law 
becomes  [16,30] 


u (t± )  =  -  K^xCt^  -  2'(t1_1 ) 3 


+  Kl[C  D  ]  x  (t,  ,)  -  [C  D  ]  x(t,  ,) 

— z  )  — m  — m  -m  l-i  — y  —  i-1 


W 


*WV  -Wi” 

*  yvv  -vw1 


uCt^l) 


(II-25) 


where,  in  terms  of  the  PI  regulator  development  in  Appendix  A  and 
(11-22)  and  (11-23), 


-x  =  +  Zc&l 


(il-26a) 


4  ~  4:1-12  +  4  2^22 


(II-26b) 


K  s  K  A.,  ♦  A01 
— xm  — x-11  -21 


(II-26c) 


K  s  K  A._  +  A__ 
-xu  -x-12  -22 


(II-26d) 


K  s  K  A._  ♦  A„ 

-xn  -x-13  -23 


(II-26e) 


The  time  argument  of  the  u  (t. )  term  in  the  second  line  of  (11-25)  is  a 

-m  1 

consequence  of  the  need  to  ensure  consistency  in  the  equations  for  the 
ideal  state  trajectory  (11-20  and  11-21)  as  the  system  undergoes  a 


5 


change  in  the  value  of  the  model  input,  Such  a  change  requires 

that  the  time  argument  of  the  model  input  be  advanced  by  one  sample 

period  in  (11-17),  providing  direct  feedthrough  of  u  to  x  .  While 

— m  - m 

this  precludes  precomputation  of  x  (t, )  in  the  background  between 

— m  1 

sampling  points,  it  also  improves  the  initial  transient  performance  of 
the  system  by  speeding  up  the  command  model  by  one  sampling  period 
[16,30]. 

The  final  step  in  the  development  of  the  overall  CGT/PI/KF  is  the 

incorporation  of  a  standard  steady -state,  constant-gain  Kalman  filter 

to  provide  estimates  of  the  system  states  and  disturbances.  Due  to  the 

certainty  equivalence  property  of  LQG  designs  discussed  earlier,  this 

does  not  change  the  form  of  the  control  law;  x(t. )  and  n, (t. )  are 

—  i  —a  l 

simply  replaced  by  the  filter  estimates  [30].  The  dynamics  model  for 
the  filter  consists  of  the  design  model  for  system  dynamics  augmented 
with  the  time-correlated  disturbance  model,  and  the  measurements  are 
modelled  as 


z  ( t  )  =  [H  H  ] 
—  1  —  — n 


x(ti) 

2d(V 


+  _v(  t^  ) 


(11-27) 


where  vU^)  is  a  zero-mean,  discrete-time  white  Gaussian  noi3e  of 
covariance  JR. 

The  calculation  of  the  various  gains  in  the  final  control  law 
requires  extensive  matrix  algebra  and  a  degree  of  trial-and-error 
iteration  with  varying  performance  index  weights,  all  of  which  is  the 
purpose  of  the  software  developed  by  Floyd  and  Moseley.  To  use  the 
software,  the  designer  must  specify  the  models  and  performance  index 
weights;  these  include  weights  on  output  deviations,  inputs  and  input 


11-16 


rates,  plus  weights  on  output  rate  deviations  when  implicit 
model-following  is  desired.  The  program  CGTPIF  [16, 34]  will  solve  for 
all  of  the  required  gains  and  conduct  a  performance  analysis  of  each  of 
the  individual  components  of  the  controller.  If  a  Kalman  filter  is 
designed,  the  program  PFEVAL  [34]  can  be  run  to  conduct  a  covariance 
analysis  of  the  entire  controller/filter  structure  as  a  unit,  as  well 
as  a  statistical  analysis  of  a  controller  that  assumes  perfect  access 
to  all  states  (to  display  the  impact  of  the  filter  on  performance 
explicitly).  Both  programs  allow  performance  analysis  using  a  linear 
truth  model  to  evaluate  the  controller  in  a  realistic  environment.  To 
evaluate  controller  robustness,  a  truth  model  which  differs  substan¬ 
tially  (in  dimensionality  as  well  as  coefficient  values)  from  the 
design  model  may  be  used.  The  controller  design  software  (CGTPIF) 
written  by  Floyd  [16]  and  modified  by  Moseley  [34]  was  used  with  only 
minor  modifications  in  this  study;  the  version  used  is  documented  in 


Appendix  D 


2.4  Summary 

In  this  chapter,  the  use  of  model-following  was  shown  to  provide  a 
means  of  incorporating  conventional  time-domain  specifications  into 
controller  designs  achieved  through  the  use  of  modern,  LQ  design 
methods.  The  structure  of  a  particularly  useful  model-following 
configuration,  the  CGT/PI/KF  controller,  was  outlined  in  some  detail. 
The  employment  of  implicit  model-following  in  controller  design 
directly  affects  the  closed-loop  characteristics  of  the  resulting 
system,  including  stability  robustness.  In  the  chapter  that  follows, 
methods  of  analyzing  and  enhancing  the  stability  robustness  of  MIMO 
control  systems  are  presented. 


III.  Robustness  Analysis  and  Enhancement 


i 


3.1  Introduction 


sA 


This  chapter  deals  with  methods  for  analyzing  the  stability 
robustness  in  MIMO  control  systems,  as  well  as  techniques  that  can  help 
improve  the  robustness  characteristics  of  LQG  controllers.  Singular 
value  analysis  is  shown  to  be  an  intuitively  pleasing  multi-loop 
generalization  of  classical  SISO  design  techniques  that  can  be  applied 
to  both  stability  robustness  and  performance  characteristics.  The  use 
of  implicit  model-following  to  affect  the  eigenstructure  of  the 
closed-loop  control  system  is  discussed  as  a  means  of  robustness 
enhancement.  Finally,  a  method  for  recovering  a  degree  of  the 
robustness  lost  in  replacing  full-state  feedback  with  Kalman  filter 
state  estimates  is  introduced. 


$ 


3 .2  Singular  Value  Analysis 

Consider  the  simple  continuous-time,  linear,  time-invariant 


control  system  shown  in  Figure  III-1.  The  plant  is  represented  by  the 
£  transfer  function,  K  is  the  controller,  r  is  the  forcing  command, 
is  the  output,  and  n  and  v  are,  respectively,  disturbances  arid 
measurement  noise.  Although  the  disturbances  are  depicted  as  entering 
the  system  at  the  plant  output,  it  is  obvious  that  disturbances  might 
as  well  be  shown  entering  at  the  control  input;  the  choice  here  is 
merely  for  simplification  of  the  presentation.  Also,  this  structure 
assumes  that  noise  corrupted  measurements  of  all  outputs  are  available. 
While  a  unity  feedback  configuration  is  depicted,  the  addition  of  a 
precompensator  (P)  allows  generalization  to  an  equivalent  unity 


III-1 


v'v'' 


feedback  representation  of  a  non-unity  feedback  controller  [14] 
including  such  configurations  as  the  CGT/PI/KF. 


Figure  III-1.  Typical  Control  System  [14]. 


As  stated  in  Chapter  II,  the  pre compensator  is  outside  of  the  loop,  so 
it  will  not  affect  the  closed-loop  characteristics,  including 
robustness,  of  this  linear  system.  The  output  of  this  control  system 


X  =  GK(I  +  .OO^r-v)  ♦  (I  +  GK-)1  n 


(III-1) 


Now  consider  the  familiar  SISO  case  in  which  all  of  the  above 
quantities  are  scalar.  The  complex  scalar  gk  is  referred  to  as  the 
loop  gain  of  the  system,  and  the  complex  function  (1  +  gk)  is  the 
system's  return  difference  function.  Classical  design  theory  states 
that  the  system's  command  tracking,  disturbance  rejection  and 
sensitivity  to  modelling  errors  will  be  good  over  the  range  of  input 
frequencies  where  (the  determinant)  |l  +  gk|  is  large,  or  where  |gk 


is  ouch  larger  than  1  (i.e.,  the  system  bandwidth)  [43],  Designing  for 
this  consideration  is  limited  by  the  response  to  measurement  noises 
(the  same  as  to  commands)  and  stability  (43].  The  stability 
restriction  on  the  loop  gain  is  commonly  stated  in  terms  of  the  Nyquist 
Criterion:  the  number  of  counterclockwise  encirclements  of  the 
(  -1  +  JO  )  point  in  the  complex  plane  realized  by  the  function  gk(ju>) 
must  be  equal  to  the  number  of  unstable  modes  (right-half-plane  zeros) 
of  the  function  [8].  This  is  the  same  as  the  requirement  that  the 
system  possess  positive  gain  and  phase  margins;  since  most  physical 
systems  can  be  described  by  transfer  functions  with  a  pole-zero  excess 
of  at  least  two  [21],  the  frequency  range  over  which  the  magnitude  of 
the  loop  gain  may  exceed  unity  is  limited  by  the  frequency  at  which  the 
phase  angle  exceeds  180  degrees. 

At  this  point  it  is  necessary  to  consider  the  existence  of 
modelling  errors  and  parameter  uncertainty  in  the  plant  representation 
(g).  If  the  actual  value  of  g  differs  from  the  design  model  value  by 
an  amount  up  to  and  including  Ag>  then  the  possibility  exists  that  the 
actual  system’s  performance  will  be  degraded.  An  even  more  serious 
possibility  is  the  loss  of  stability  due  to  the  perturbation.  Perfor¬ 
mance  degradation  can  be  assessed  by  reevaluating  the  bandwidth  of  the 
loop  gain  using  the  true  (in  the  worst  case)  plant,  g'=  g  +  Ag; 
stability  can  only  be  guaranteed  if  no  value  of  g'  in  the  range 
specified  causes  the  number  of  Nyquist  encirclements  to  change. 

In  many  cases,  a  designer  will  have  some  insight  into  the  types 
and  magnitudes  of  parameter  uncertainties  in  the  design  model;  they  may 
be  the  result  of  intentionally  ignored  modes,  nonlinearities  or  time 
variations.  As  might  be  expected,  special  design  and  analysis  methods 


can  be  applied  when  the  structure  of  the  modelling  uncertainty  is  known 
C 12, 15# 18,273 •  A  most  general  class  of  uncertainties  (norm-bounded  but 
otherwise  unconstrained,  or  "unstructured")  will  be  considered  in  this 
thesis.  In  most  cases,  the  low  frequency  characteristics  of  physical 
systems  are  relatively  well  known  and  are  readily  expressed  using 
linear  or  linearized  perturbation  models.  At  higher  frequencies, 
system  characteristics  generally  become  more  nonlinear  and  less 
predictable.  The  perturbations  to  the  design  model  frequently  exceed 
the  magnitude  of  the  nominal  transfer  function  at  high  frequencies,  and 
phase  uncertainties  may  exceed  ±180  degrees  [14].  The  need  to  ensure 
stability  in  the  face  of  such  uncertainties  is  reflected  in  the  phase 
and  gain  margin  requirements  of  classical  SISO  design.  Even  in  the 
SISO  case,  however,  analysis  of  gain  and  phase  margins  does  not  fully 
reflect  the  true  stability  robustness  of  a  control  system,  because  it 
does  not  indicate  the  minimum  amount  of  simultaneous  gain  and  phase 
variation  required  to  produce  Instability.  The  Nichols  plot  [8]  of 
Figure  III-2  is  an  example  of  a  system  with  good  gain  and  phase  margin, 
but  very  poor  robustness,  since  a  very  small  simultaneous  change  in 
gain  and  phase  could  produce  instability. 


Figure  III-2.  Nichols  Plot  Displaying  Good  Gain  and 
Phase  Margins,  but  Poor  Robustness. 

In  the  case  of  multi-loop  control  systems,  an  analysis  of 
stability  robustness  that  parallels  that  of  the  SISO  case  is 
complicated  further  by  the  need  to  consider  simultaneous  phase  and  gain 
variations  in  all  possible  combinations  of  loops.  This  is  due  to  the 
fact  that,  in  most  cases,  the  control  loops  are  coupled,  and  changes  in 
one  loop  will  affect  other  loops  in  the  system.  Since  such  an  analysis 
would  be  a  monumental,  if  not  impossible,  task  for  systems  consisting 
of  many  loops,  a  more  powerful  tool  is  needed.  In  particular,  a  means 
of  assessing  the  "size”  of  the  G  and  _K  matrices  and  their  mapping 
effect  on  the  system  inputs  and  outputs  (analogous  to  scalar  gains) 
will  be  useful  in  generalizing  the  scalar  concepts  already  discussed. 

The  spectral  norm  1*11  for  an  n-by-n  matrix  A  is  defined  by 


II  A II  =  max  II  A  x  s  max  II  A  x  II  /II  x  II 


(III-2) 


and  is  a  measure  of  the  "size"  of  the  matrix  and  its  mapping  effect  on 

the  vector  x  [30].  The  singular  values,  through  <r  ,  of  the 

(possibly)  complex  matrix  A  are  defined  as  the  non-negative  square 

*  * 

roots  of  the  eigenvalues  of  A  A,  where  A  is  the  conjugate  transpose  of 


k  [11].  The  singular  values 

of  A  and  the  norm  ||  k  || 

are  related  by  the 

inequalities 

Wi>  ■  "H 

a1!! 

(III-3) 

<w<±>  •  *  IU 

II 

(III-4 ) 

so  that  knowledge  of  the  minimum  and  maximum  singular  values  of  a 
matrix  provides  information  as  to  the  maximum  "gain"  effect  it  can  have 
as  well  as  its  closeness  to  singularity  C 303 -  This  information  cannot 
be  obtained  through  analysis  of  the  eigenvalues  of  A;  although,  for  all 
eigenvalues  of  A, 

9  <  | A  |  <  v  (III-5) 

the  smallest  eigenvalue  may  be  much  larger  than  £  [11].  It  is  possible 
to  reduce  any  n-by-n  nonsingular  matrix  to  the  form 

A  =  U  2  V  (II 1—6 ) 

where  U  and  V  are  unitary  matrices  and  2  is  a  diagonal  matrix  whose 
elements  are  the  singular  values  of  A.  The  process  is  called  singular 
value  decomposition,  and  can  be  performed  by  available  computer 
software  [9»24]. 

Now  consider  the  MIMO  case  for  the  control  system  of  Figure  III— 1 . 
The  scalar  loop  gain  of  the  SISO  system  is  replaced  by  a  matrix 


function,  and  now  a  distinction  must  be  made  as  to  where  the  loop  is 
broken.  If  the  loop  is  cut  at  a  point  between  the  controller  and  the 


plant,  then  the  loop  gain  is  KG;  if  it  is  cut  at  the  plant  output,  the 
loop  gain  is  GK.  In  general,  the  two  will  be  different.  The  return 
difference  scalar  function  is  also  replaced  by  a  return  difference 
matrix,  which  also  depends  on  the  point  at  which  the  loop  is  cut.  The 
role  of  these  matrices  in  performance  and  stability  analysis  is 
analogous  to  that  of  their  scalar  counterparts,  but  due  to  the  multi¬ 


variable  nature  of  the  problem,  such  analysis  is  more  complicated.  In 
the  MIMO  case,  the  mapping  effect  of  the  loop  and  return  difference 
matrices  is  dependent  not  only  on  the  matrices  themselves,  but  on  the 


direction  of  the  vector  quantity  that  is  being  mapped.  As  a  related 
example,  the  eigenvalues  of  a  multi-loop  system  define  the  modes  of  the 
system's  response  to  any  excitation,  while  its  eigenvectors  determine 


the  distribution  of  the  response  energy  based  on  the  relative  direc¬ 
tional  orientation  of  the  excitation  and  the  responding  loops. 

Singular  value  analysis  provides  insight  into  the  minimum  and  maximum 
effects  of  a  matrix  function,  so  that  the  most  pessimistic  prospects 
for  performance  and  robustness  can  be  assessed.  While  pessimism  is  not 
necessarily  a  bad  thing,  the  conservatism  inherent  in  this  measure  can 


in  some  circumstances  be  arbitrarily  large,  thus  rendering  it  somewhat 


useless.  The  degree  to  which  this  is  true  is  a  function  of  the 
problem  being  analyzed  [12]. 


The  minimum  singular  value  of  the  system's  loop  gain  matrix  can  be 
used  to  assess  the  minimum  bandpass  of  any  loop  in  the  system  for 
inputs  which  occur  in  an  arbitrary  direction.  The  magnitude  of  the 


minimum  singular  value  is  a  measure  of  system  performance;  good 
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performance  generally  results  when  this  value  is  large  over  the  desired 
frequency  range  [14].  The  maximum  singular  value  is  an  estimate  of  the 
maximum  response  in  any  loop  to  an  arbitrary  input  and,  as  with 
single-loop  designs,  it  is  important  to  ensure  that  this  value  is  small 
(much  less  than  1)  at  frequencies  where  significant  uncertainty  exists. 
In  effect,  the  low  frequency  performance  specifications  and  high 
frequency  stability  requirements  provide  boundaries  within  which  the 
designer  attempts  to  restrain  the  loop  gain  matrix  singular  values,  as 
shown  in  Figure  III-3  [14].  While  this  concept  provides  some  ability 
to  evaluate  limits  of  performance  and  absolute  stability,  a  more 
concise  measure  of  the  amount  of  uncertainty  which  can  be  tolerated  in 
the  loop  without  causing  instability  is  required  as  a  true  measure  of 
stability  robustness. 


Figure  III-3.  Design  Boundaries  for  Singular  Values  [14] 


If  the  nominal  system  is  stable  and  the  uncertainty  can  be 


represented  as  a  multiplicative  alteration  (the  type  which  corresponds 
to  the  classical  concepts  of  gain  and  phase  margins)  of  the  form 
(I_  ♦  L),  so  that  the  perturbed  loop  gain  (with  the  loop  cut  at  the 
control  input)  is 

KG'  =  (I  ♦  L)  KG  (III-7) 

then  it  can  be  shown  [11, 1^,30]  that  no  perturbation  L  such  that 
~v  (L)  <  l  will  change  the  number  of  Nyquist  encirclements  of  the  loop 
gain  as  it  is  allowed  to  vary  from  KG  to  KG'  if  it  is  true  that 

/  <  1/  7(1  -  [I  ♦  KG]-1)  (III-8) 

Employing  the  matrix  inversion  lemma  [30]  which  states  that,  for 
invertible  A, 

(I  +  A-1)"1  =  I  -  (I  +  A)"1  (III-9) 

as  well  as  (III-3)  and  (III-iJ),  (III-8)  is  equivalent  to 

/  <  £(I  +  Hfi]"1)  (HI-10) 

or 

*(L)  <  £(I  +  [KG]'1)  (III-11) 

for  all  frequencies  (in  either  the  z-  or  s-domain  [8,30]).  The 
quantity  (I  +  [JCG]-1)  is  called  the  inverse  return  difference  matrix 
function  for  the  system.  The  maximum  value  of  l  for  which  the 
inequality  in  (III-10)  holds  is  a  measure  of  the  stability  robustness 
of  the  closed-loop  control  system.  Use  of  this  measure  will  be  made  in 
the  remainder  of  this  thesis;  expressions  for  the  loop  gain  and  inverse 


return  difference  matrices  for  the  CGT/PI/KF  are  developed  in  Appendix 

B. 

Analysis  of  the  effects  of  such  arbitrary  perturbations,  or 
"unstructured  singular  value  analysis,”  has  a  major  drawback  in  that  it 
considers  perturbations  that  might  never  physically  occur;  the 
robustness  estimates  are  therefore  conservative.  If  a  designer  has 
considerable  information  about  the  possible  structure  of  uncertainties 
likely  to  occur,  then  in  many  cases  much  tighter  and  more  realistic 
bounds  can  be  place  on  robustness  estimates  through  the  use  of  more 
complex  methods  of  "structured  singular  value  analysis”  [ 12, 15, 18,273. 
These  will  not  be  pursued  further  in  this  thesis  effort,  but  are 
potentially  fruitful  for  future  research. 


3.3  Analysis  Through  Simulation 

An  excellent  alternative  method  of  assessing  the  robustness  of  a 
control  system  design  is  through  actual  simulation,  in  which  the 
control  law  is  allowed  to  operate  on  a  truth  model.  The  truth  model 
can  be  altered  to  represent  any  number  of  physically  feasible 
perturbations  to  the  design  model,  including  previously  ignored 
dynamics  and  nonlinearities.  With  the  use  of  simulation,  there  is  no 
issue  of  conservatism,  and  the  stability  of  the  control  system  with 
respect  to  the  perturbed  model  can  be  fully  evaluated  for  any  and  all 
physically  important  perturbations.  However,  there  is  an  infinite 
number  of  possible  perturbed  models  to  be  considered,  so  considerable 
judgment  is  required  in  the  conduct  of  such  analysis.  This  more 
conventional  means  of  robustness  evaluation  was  used  extensively  in 


this  study,  both  as  a  complement  to  singular  value  analysis  and  as  a 
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means  of  assessing  the  usefulness  of  singular  value  analysis. 

3.4  Robustness  Enhancement  Methods 

The  primary  design  tool  for  robustness  enhancement  that  was  to  be 
employed  in  this  study  was  the  use  of  implicit  model-following  to 
affect  the  eigenstructure  of  the  closed-loop  control  system.  Gilbert 
demonstrated  that  the  sensitivity  of  the  characteristic  roots  of  a 
matrix  to  variations  in  the  matrix  elements  is  minimized  when  the 
nominal  eigenvectors  of  the  matrix  are  made  as  nearly  orthogonal  as 
possible  [191.  Since  the  designer  has  a  considerable  amount  of  freedom 
in  assigning  the  eigenstructure  of  a  multivariable  system  [1,33]. 
choosing  closed-loop  system  eigenvectors  that  are  maximally  orthogonal 
will,  in  general,  produce  robustness  benefits  in  that  the  system  will 
be  less  sensitive  to  parameter  variations.  Many  techniques  are 
available  that  can  be  used  in  control  system  eigenstructure  assignment. 
Broussard  and  Berry  have  shown  that  one  such  method  is  the  use  of 
implicit  model-following  [6].  The  minimization  of  an  LQ  performance 
index  that  is  based  on  an  implicit  model,  as  shown  in  Section  2.2,  has 
a  direct  effect  on  the  closed-loop  system  characteristics.  This  is 
because  the  feedback  control  causes  the  eigenvalues  and  eigenvectors  of 
the  closed-loop  system  to  tend  to  match  those  of  the  implicit  model. 
With  the  CGT/PI/KF  controller  configuration  as  formulated  by  Floyd  and 
Moseley  [16,34],  the  designer  can  choose  not  only  the  implicit  model  to 
be  used  (which  need  not  be  the  same  as  the  CGT  command  model),  but  the 
relative  weighting  in  the  performance  index  given  to  implicit  versus 
explicit  model-following  control.  By  choosing  an  implicit  model  for 
the  regulator  design  with  desired  eigenvalues  and  orthogonal  eigen- 
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vectors,  increasing  the  relative  weighting  on  implicit  model-following, 
and  by  matching  a  greater  number  of  system  states  to  a  desirable 
implicit  model,  the  designer  should,  to  some  extent,  be  able  to 
approach  an  optimally  robust  eigenstructure  in  the  controlled  system. 
This  method  of  eigenstructure  assignment  would  be  one  which  provides  a 
great  deal  of  insight  for  the  designer  in  progressing  through  an 
iterative  design  process.  It  should  be  noted  that  various  other 
methods  of  achieving  eigenstructure  assignment  are  discussed  in  current 
literature  [1,20]. 

Full-state  LQ  optimal  steady-state  feedback  laws  have  been  shown 
to  possess  impressive  guaranteed  robustness  characteristics.  For 
continuous-time  controllers  (and  in  the  limit,  as  sampling  time  goes  to 
zero,  for  sampled-data  controllers)  these  guarantees  include  infinite 
simultaneous  gain  margins  and  at  least  60  degree  phase  margins  in  all 
loops  [30,39]*  Since  they  are  valid  only  for  linear  systems  with 
full-state  feedback,  these  guarantees  are  largely  theoretical.  Real 
systems  are  not,  in  general,  linear;  nor  are  they  finite-dimensional. 
Thus,  the  concept  of  linear,  full-state  feedback  is  itself  somewhat 
fictitious.  Even  when  large  gain  and  phase  margins  can  be  achieved, 
stability  under  simultaneous  gain  and  phase  variations  is  not 
guaranteed,  as  shown  in  Section  3*2.  Despite  the  preceding  criticism 
of  theoretical  robustness  guarantees,  when  the  linear  model  of  the 
system  is  adequate,  full-state  LQ  feedback  controllers,  based  on  such  a 
model,  are  inherently  quite  robust  [30]. 

Even  when  an  extremely  robust  full-state  feedback  design  is 
achievable,  the  introduction  of  an  observer  such  as  the  Kalman  filter 
into  the  system  to  provide  estimates  of  states  that  are  not  perfectly 


accessible  produces  a  degradation  in  stability  robustness.  There  are 
no  robustness  guarantees,  even  theoretical  ones,  for  LQG  controllers 
[10].  This  is  due  to  the  dependence  of  the  filter  on  an  internal 
system  model  [12,30].  Doyle  and  Stein  [13]  have  shown  that  the  lost 
robustness  may  be  asymptotically  recovered  in  continuous-time,  minimum 
phase  control  systems  (at  the  expense  of  optimal  filter  performance 
under  design  conditions)  by  the  systematic  introduction  of  a  pseudo¬ 
noise  into  the  model  upon  which  the  filter  is  based,  at  the  entry 
points  of  the  controls.  An  extension  of  this  technique  for  discrete 
systems  was  produced  by  Capt  Lloyd  [28].  To  apply  this  technique,  the 
term,  representing  the  strength  of  the  noises  driving  an  augmented 
system  model  based  on  (11-14)  and  (11-16),  or 
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where  At  is  the  controller  sampling  time  interval,  B  is  the 
continuous-time  control  matrix,  and  V  is  a  positive  definite  matrix 
which  the  designer  may  choose  to  affect  the  relative  rates  of  recovery 
in  various  loops.  In  effect,  this  method  causes  some  of  the  filter 
poles  to  migrate,  as  the  value  of  q  is  increased,  toward  stable  plant 
zeroes.  The  robustness  lost  due  to  the  presence  of  the  filter  can  thus 
be  asymptotically  recovered,  as  q  is  allowed  to  approach  infinity,  in  a 
number  of  control  system  loops  equal  to  the  number  of  filter  measure¬ 
ments  [43].  A  dual  to  this  approach  was  given  by  Stein  and  Sandell 
[43]  who  credit  it  to  Kwakernaak  [26];  this  method  involves  systemat¬ 
ically  increasing  the  quadratic  state  weightings  in  the  regulator 
design  in  a  manner  analogous  to  (III-15),  causing  the  regulator  poles 
to  migrate.  While  Kalman  filter  designs  and  robustness  recovery 
techniques  were  not  pursued  in  this  study,  a  concurrent  effort  by  Lt 
Jean  Howey  [22]  has  centered  on  such  procedures,  and  should  be 
considered  as  complementary  required  reading. 

3.5  Summary 

In  this  chapter,  methods  of  analyzing  and  enhancing  the  stability 
robustness  of  MIMO  control  systems  was  presented.  Employment  of  such 
methods  constituted  a  major  portion  of  the  work  in  this  study.  The 
next  chapter  outlines  in  more  detail  how  this  work  was  carried  out. 


IV.  Design  Objectives,  Models  and  Observations 

4.1  Introduction 

This  chapter  outlines  more  specifically  the  design  objectives 
undertaken  in  this  study,  the  models  used,  and  the  analysis  methods 
that  were  employed  in  evaluating  the  tentative  designs.  Observations 
that  emerged  during  the  course  of  the  design  iterations  involving 
implicit  model-following  regulators,  as  opposed  to  the  "standard"  PI 
regulator  formulation,  are  also  included.  It  is  hoped  that  these 
observations  will  provide  some  insight  into  the  design  path3  subse¬ 
quently  chosen  in  this  study,  and  that  they  will  help  the  reader  to 
understand  the  design  results  detailed  in  Chapter  V.  It  was  originally 
hoped  that  these  observations  would  also  be  instructive  for  designers 
who  might  choose  to  atteapt  implicit  model-following  regulator  designs. 
However,  the  extent  to  which  some  of  the  ideas  are  true  has  been 
affected  by  the  error  discovered  in  the  design  software.  The  reader  is 
referred  to  Appendix  E  for  more  information  regarding  designs  using  the 
corrected  software. 


4.2  Design  Models  and  Objectives 

The  overall  objective  of  this  study  was  to  try  to  use  implicit 
model-following  in  the  design  of  a  multivariable  control  system,  as  a 
means  of  enhancing  controller  capability  and  robustness  in  the  face  of 
a  variety  of  realistic  uncertainties.  The  primary  design  tool  which 
was  to  be  used  was  the  software  (CGTPIF)  written  by  Floyd  and  Moseley 
for  the  interactive  design  and  analysis  of  CGT/PI/KF  controllers 
[16,34].  Minor  corrections  and  modifications  made  to  that  software  for 


the  purposes  of  this  study  are  documented  in  Appendix  D;  the  version 
used  herein  will  henceforth  be  referred  to  as  CGTPIV  (CGT/PI  design 
program.  Variant). 

A  CGT/PI  controller  for  the  Advanced  Fighter  Technology 
Integration  (AFTI)  F-16  was  chosen  as  the  example  controller  to  be 
designed.  The  AFTI  F-16  is  an  aircraft  which  has  been  modified  for 
advanced  flight  control  research.  Through  the  use  of  two  independently 
controlled  longitudinal  flight  control  surfaces  (a  horizontal  tail  and 
a  trailing  edge  wing  flap),  it  is  possible  to  achieve  direct  control  of 
the  aircraft's  pitch  attitude  without  changing  its  flight  path  angle 
and,  hence,  its  flight  trajectory.  This  capability  is  expected  to  be 
very  useful  in  situations  such  as  air-to-air  gunnery,  in  which  the 
attacker  must  match  the  target's  trajectory  while  simultaneously 
achieving  the  required  gun  lead  angle  in  the  pitch  plane.  The  design 
of  a  pitch-pointing  controller  for  the  AFTI  F— 1 6  was  the  primary  design 
example  used  in  previous  theses  involving  the  CGT/PI/KF  controller 
configuration  and  design/evaluation  software  [16,3^3*  Such  a  design 
was  of  interest  for  this  study,  since  it  inherently  requires  the  use  of 
MIMO  design  methodology  to  achieve  decoupled  control  of  the  two  outputs 
and  maintain  closed-loop  stability  with  a  plant  (the  F-16  aircraft) 
which  is  unstable. 

The  efforts  of  this  study  used  the  design  model  for  the  AFTI  F-16 
which  was  developed  in  Capt  Floyd's  thesis  [16].  The  model  represents 
the  linearized  flight  characteristics  of  the  aircraft  operating  at  .8 
mach  at  10,000  feet.  It  is  a  time-invariant,  five-state  model  in  the 


x  =  Ax  +  Bu 


where  the  state  vector  x  consists  of 


x(1)  s  pitch  angle  (degrees) 

x(2)  =  angle  of  attack  (degrees) 

x(3)  =  pitch  rate  (degrees  per  second) 

x(4)  s  horizontal  tail  deflection  (degrees) 

x(5)  =  trailing  edge  flap  deflection  (degrees) 

x(1)  -  x(2)  =  flight  path  angle  (degrees) 


and 
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0 
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Note  that,  in  this  design  model,  actuators  are  represented 
characteristics  of  a  first-order  lag  response  to  commands. 


(IV-1) 


(IV-2) 


(IV-3) 


(IV-4) 

as  having 
The  outputs 


are  expressed  as 


y  s  Cx 


(IV-5) 


where 


1  -1 


(IV-6) 


In  other  words,  the  outputs  of  interest  are  the  pitch  angle  and  the 
flight  path  angle. 

This  model  was  used  as  the  basis  for  both  controller  design  and 
initial  design  evaluation  using  the  CGTPIV  software.  For  subsequent 
further  evaluations,  alternate  truth  models  were  developed  which 
differed  from  the  design  model  in  terms  of  flight  characteristics  and 
in  the  inclusion  of  higher-order  and  nonlinear  actuator  dynamics. 
Various  command  models  were  used  throughout  this  study,  depending  on 
the  application  and  objective.  Since  the  command  model  was  a 
designer-selected  parameter,  each  of  the  command  models  used  will  be 
discussed  as  such  in  Chapter  V,  along  with  the  designs  in  which  they 
were  employed. 

Specifically,  the  design  objective  was  to  design  a  CGT/PI 
pitch-pointing  controller  wherein  the  PI  regulator  was  to  be  designed 
using  the  implicit  model-following  concept.  The  feasibility  of  an 
"all-implicit"  regulator  was  to  be  determined,  and  the  performance  and 
robustness  characteristics  of  such  a  design  investigated.  In 
particular,  the  utility  of  implicit  model-following  in  enhancing 
controller  robustness  in  the  face  of  various  forms  of  uncertainty  was 
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to  be  evaluated.  The  baseline  for  evaluating  the  relative  "goodness" 
of  the  implicit  designs  was  the  CGT/PI  controller,  developed  in  Capt 
Floyd's  thesis  [16],  which  was  based  on  the  design  model  just  defined. 
That  controller  design,  which  did  not  employ  implicit  model-following, 
was  duplicated  and  extensively  evaluated  early  in  this  study.  Its 
design  parameters,  performance  characteristics  and  limitations  are 
discussed  at  length  in  Chapter  V. 

4.3  Analysis  Methods 

The  controllers  developed  in  this  study  were  evaluated  by  various 
methods  to  determine  their  suitability,  both  in  an  absolute  sense  and 
in  comparison  to  the  example  standard  CGT/PI  design  used  as  the 
baseline. 

A  computer  program  called  CGTSVD  (CGT  Singular  Value  Decomposi¬ 
tion)  was  developed  which  calculates  the  minimum  and  maximum  singular 
values  of  the  loop  gain  and  inverse  return  difference  matrices  of  a 
CGT/PI/KF  controller,  as  a  function  of  frequency.  The  program  and  its 
capabilities  are  documented  in  Appendix  B.  For  this  study,  CGTSVD  was 
used  only  for  the  calculations  involving  the  inverse  return  difference 
function.  As  shown  in  Section  3.2,  the  minimum  singular  value  of  this 
function  is  a  measure  of  robustness  with  respect  to  a  multiplicative 
perturbation.  Analysis  of  this  type  of  perturbation  corresponds  to 
classical  analysis  of  SISO  gain  and  phase  margins  [30].  Calculations 
were  conducted  with  the  loop  broken  at  the  control  input,  since  those 
performed  with  the  loop  broken  at  the  output  required  the  use  of  a 
matrix  pseudoinverse,  and  the  impact  on  the  results  was  not  well 
understood.  The  results  of  the  singular  value  analysis  were  then 
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compared  to  simulation  results  in  an  effort  to  evaluate  the  predictive 
capability  of  this  type  of  singular  value  analysis  with  regard  to 
design  robustness. 

Neither  the  LQG  design  methodology  nor  the  design  and  evaluation 
software  cited  thus  far  permit  any  "hard"  constraints  or  nonlinearities 
in  the  system  to  be  considered.  A  computer  program  called  ODEACT 
(using  an  integration  package  called  ODE  to  simulate  various  ACTuator 
models),  documented  in  Appendix  C,  was  written  to  provide  the 
capability  to  evaluate  the  controller  designs  using  a  variety  of 
nonlinear  and  higher-order  actuator  models,  and  with  varying  flight 
parameters.  The  program  uses  a  "predictor-corrector"  style  of 
numerical  integration  scheme,  implemented  in  a  subroutine  called  ODE 
[42],  to  simulate  the  dynamics  of  the  controlled  system  in  conjunction 
with  the  controller  being  evaluated.  If  only  higher-order  dynamics  had 
been  of  interest,  then  the  linear  truth  model  analysis  capability  of 
CGTPIV  (for  deterministic  controllers)  or  PFEVAL  (for  stochastic 
controllers)  could  have  been  used.  It  was  the  need  to  model  the 
actuator  nonlinearities  (saturation)  that  actually  motivated  the 
development  of  ODEACT. 

The  analysis  of  the  baseline  design  through  the  use  of  ODEACT 
indicated  that  hard  constraints  on  actuator  positions  and  rates 
severely  restricted  the  usefulness  of  that  controller.  The  limits  used 
for  the  simulation  included  a  maximum  deflection  of  25  degrees  in 
either  direction  at  a  maximum  rate  of  60  degrees  per  second  for  the 
horizontal  tail.  Limits  for  the  flap  were  4-20  degrees  and  -23  degrees 
at  a  maximum  rate  of  52  degrees  per  second  [16,17].  Achieving  the 
capability  to  perform  under  these  restriction  was  one  of  the  main 
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improvements  sought  through  the  use  of  implicit  model-following. 

Addition  of  a  higher-order  model  for  the  actuators  also  tended  to 
reduce  stablility  in  the  baseline  and  other  designs,  and  thus 
demonstrated  another  area  in  which  improvement  was  needed.  Again,  the 
improvement  was  sought  through  the  use  of  implicit  model-following. 

The  design  model  for  the  actuators  (referred  to  in  this  thesis  as  the 
single-state  actuator  model)  was  a  first-order  lag  with  a  time  constant 
of  0.05  seconds.  The  transfer  function  between  the  commanded  input  5, 


and  the  achieved  output  was,  therefore. 


s  +  20 


The  alternate  actuator  truth  models  [17]  consisted  either  of  a 


(IV-7) 


third-order  system  (also  referred  to  herein  as  the  three-state  actuator 


model)  with  a  transfer  function  of 


(20.2) (71 .4) 


[s+20.2][s2  +2(.736)(71.4)s+(71.4)2] 
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or  a  fourth-order  system  (referred  to  as  the  four-state  actuator  model) 
with  a  transfer  function  of 


(20.2) ( 144.8) (71 .4) 

[s+20.2][s+144.8][s2  +2( .736) (71 .4)s+(71 .4)2]  (IV-9) 


In  general,  initial  analyses  with  respect  to  the  higher-order  actuator 
models  were  conducted  without  applying  the  nonlinear  actuator 
saturation  constraints,  so  that  the  effects  of  each  could  be  studied 


separately.  Additional  tests  were  also  conducted  with  combined 
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nonlinear,  higher-order  actuators. 

To  evaluate  the  sensitivity  of  the  regulator  designs  to  parameter 
variations,  ODEACT  was  again  used.  It  should  again  be  noted  that  this 
analysis  could  have  been  conducted  by  using  various  linear  truth  models 
with  CGTPIV  or  PFEVAL;  it  was  simply  easier,  in  this  case,  to  conduct 
the  "after-design"  analysis  of  a  large  number  of  controllers  and 
conditions  with  ODEACT.  The  first  truth  model  was  developed  by 
increasing  the  values  of  three  of  the  stability  derivatives  (Za,  Ma  and 
M^)  that  were  used  in  the  design  model  by  20%,  exactly  as  was  done  in 
[16]  to  evaluate  the  original  baseline  design.  Za  is  the  stability 
derivative  that  relates  the  forces  acting  along  the  aircraft  body 
z-axis  to  changes  in  angle  of  attack.  Ma  relates  the  change  in 
pitching  moment  (about  the  body  y-axis)  to  changes  in  angle  of  attack, 
and  Mq  relates  change  in  pitching  moment  to  changes  in  pitch  rate  [16]. 
Additional  truth  models  were  developed  by  using  data  for  significantly 
different  flight  conditions  (.6  mach,  at  20,000  and  30,000  feet).  For 
the  case  of  the  increased  stability  derivatives,  the  truth  model 
dynamics  matrix  was 
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For  the  flight  condition  at  20,000  feet,  the  truth  model  dynamics 
matrix  was 
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and  for  30,000  feet. 
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For  these  evaluations,  the  first-order  actuator  model  was  used,  and 
nonlinear  limits  were  not  applied;  thus,  only  the  effect  of  the 
parameter  variations  from  the  design  values  was  assessed. 


4.4  Observations  for  Implicit  Model-Following  Design 

The  observations  that  follow  emerged  while  working  with  the  design 
model  already  defined,  and  in  conjunction  with  the  CGTPIV  design 
software.  Although  some  of  the  observed  phenomena  may  have  been  a 
result  only  of  the  particular  design  problem  or  the  design  software 
(and  certainly  of  the  error  subsequently  discovered  in  that  software, 
as  documented  in  Appendix  E),  it  is  likely  that  much  of  what  follows 


would  also  be  true  in  general. 

4.4.1.  The  regulator  designs  were  very  sensitive  to  the 
"implicit”  quadratic  weights  placed  on  the  output  deviation  rates. 

These  weights  constituted  the  ^  matrix  of  (a-43),  referred  to  as  "QI" 
by  the  CGTPIV  program  output.  In  generating  the  performance  index  of 
(A-44),  these  weights  are  combined  with  the  output,  dynamics  and 
command  model  dynamics  matrices  to  define  an  implicit  state  weighting 
matrix.  In  the  program  CGTPIV,  the  result  is  referred  to  as  the  "QIH" 
matrix,  which  is  actually  the  ^  matrix  of  (A-45a). 

%  =  ( CA  -  4C)T%(CA  -  k^C)  (A-45a) 

This  operation  distributes  weights  on  the  system  states  that,  for  the 
models  used  in  this  study,  were  much  larger  than  would  have  been 
achieved  by  using,  instead,  an  "explicit"  output  weighting  matrix  ("Y" 
in  CGTPIV  and  (A-39))  with  a  magnitude  similar  to  that  of  Q^.  When  the 
command  model  dynamics  matrix  is  changed,  the  resulting  distribution 
changes,  and  the  effect  of  the  weights  may  be  altered  significantly. 
As  a  result,  smaller  weights  (an  order  of  magnitude  or  more)  on  the 
output  deviation  rates,  compared  to  those  which  would  be  placed 
directly  on  the  outputs  or  states  in  a  standard  regulator,  seemed  to  be 
generally  appropriate. 

4.4.2.  Although  the  implicit  model-following  formulation  is  based 
on  matching  the  derivatives  of  the  actual  system's  outputs  to  those  of 
the  command  model,  instead  of  the  output  values  themselves,  the 
controller  does  provide  adequate  regulation  of  the  outputs  without  any 
need  for  the  use  of  added  "explicit"  output  weights  (i.e.,  the  Y 
matrix).  The  first  reaction  of  the  regulator  in  response  to  non-zero 


initial  conditions  was  observed  to  be  an  effort  to  drive  the  outputs 
rapidly  toward  zero.  This  resulted  in  a  short  "rise  time,"  defined, 
for  the  purposes  of  this  thesis,  as  the  time  required  for  the  pitch 
angle  output  to  achieve  or  pass  through  a  value  within  10?  of  the 
initial  excursion  from  the  desired  value  of  zero.  Once  some  of  the 
initial  output  deviation  was  nulled,  the  output  response  was  observed 
to  begin  to  follow  the  model  dynamics  more  closely.  The  effect 
appeared  to  be  amplified  with  large  weights  on  the  output  rates  (the 
matrix),  and  thus  in  the  implicit  state  weighting  matrix  (Qj).  Thus, 
heavy  weights  on  the  output  rates  with  a  "slow"  command  model  were  not 
found  to  be  effective  in  slowing  down  the  initial  response,  character* 
ized  by  the  rise  time  of  the  system,  as  might  have  been  anticipated. 

In  fact,  quite  the  opposite  was  observed  to  be  true. 

4.4.3.  Weights  placed  on  the  input  magnitudes  (through  the 
"explicit"  matrix  of  (A-39)  or  the  "implicit"  jjj.  matrix  of  (A-43)), 
or  placed  directly  on  the  actuator  states  (changing  the  values  of  the  JC 
matrix  of  (A-40)  is  a  CGTPIV  program  option),  were  observed  to  cause 
the  initial  control  Inputs  and  input  rates  to  be  increased.  This 
resulted  in  increased  actuator  activity.  The  controller's  strategy 
seemed  to  be  to  get  all  of  the  activity  out  of  the  way  early,  and 
settle  down  to  zero  values  as  rapidly  as  possible,  and  thus  minimize 
the  integral  of  the  squared  control/actuator  magnitudes  over  all  time. 
Typically,  this  might  not  be  what  the  designer  would  have  had  in  mind, 
nor  have  expected.  Similarly,  due  to  the  controller  structure,  if  the 
actuator  states  are  defined  as  outputs  of  the  system  and  modelled  in 
the  regulator  command  model,  weights  placed  on  the  actuator  output 
rates  heavily  weight  the  actuator  states  themselves.  Equally  important 


is  the  addition  of  large  weights  on  the  inputs  to  the  actuators  by  the 
generation  of  the  equivalent  control  weighting  matrix.  This  matrix  is 
referred  to  as  "RIH"  by  the  software,  and  is  actually  the  R.j  matrix 
defined  in  (A-45c). 

A-J.  =  Rj  ♦  1TCT%CB  (A-45c) 

Thus,  it  was  found  that  inclusion  of  the  actuator  states  in  the 
regulator  implicit  command  model  was  not  an  effective  way  of 
controlling  the  speed  of  the  regulator.  Rather,  a  reduction  in 
regulator  speed,  and  therefore  actuator  activity,  was  found  to  be 
possible  as  a  result  of  reducing  the  weights  on  the  output  rates  (Qj) 
and  the  inputs  (l^  or  IU),  and  by  modelling  additional  states  (the 
pitch  rate,  in  this  case)  as  outputs  in  the  regulator  command  model. 

An  additional  means  of  controlling  regulator  speed  is  discussed  in 
Section  4.4.4,  and  the  effectiveness  of  all  of  these  techniques  is 
shown  in  Chapter  5. 

4.4.4.  In  the  simple  development  shown  in  Section  2.2,  the 
performance  index  for  implicit  model-following  specifically  includes 
quadratic  weights  only  on  the  derivatives  of  the  outputs  and  on  the 
input  magnitudes.  But,  as  shown  in  Appendix  A,  the  perturbation  PI 
regulator  quadratic  cost  also  includes  weights  on  the  rate  of  change  in 
control  magnitudes,  and  this  is  appropriate  regardless  of  whether  or 
not  implicit  model-following  is  included  in  the  formulation.  Weights 
on  the  input  rates  were  found  to  be  required  to  prevent  inappropriate 
(and  ineffective)  high  frequency  control  input  oscillations.  In  the 
designs  attempted  in  this  study,  failure  to  apply  some  weight  to  the 
control  input  rates  resulted  in  inputs  which  were  large,  and  which 


reversed  sign  with  each  sample  period.  Weights  on  input  rates  were,  in 
fact,  found  to  be  effective  in  achieving  control  over  the  initial  speed 
(rise  time)  of  the  regulator  as  well  as  the  extent  of  overshoots  and 
control  oscillations. 

4.4.5.  The  CGTPIV  program  provides  the  user  with  the  locations  of 
the  closed-loop  regulator  poles  during  the  design  evaluation.  In 
general,  this  information  was  useful  and  was  used  extensively  in  the 
analysis  of  the  effects  of  actuator  dynamics  on  the  designs.  The 
program  produces  a  digital  controller  by  direct  digital  design  methods; 
that  is,  the  design  procedure  is  accomplished  in  the  discrete-time,  or 
z-domain,  and  does  not  make  use  of  approximations  or  mappings  to  allow 
the  use  of  s-plane,  continuous-time  design  techniques.  There  is 
therefore  nothing  to  preclude  the  resulting  controller  from  having 
poles  on  the  negative  real  axis  of  the  z-plane,  which  cannot  be  mapped 
into  the  s-domain.  When  this  situation  occurs,  the  algorithm,  used  by 
the  program  to  map  the  controller  poles  into  the  s-plane  for  display  to 
the  designer,  generates  a  pole  with  an  imaginary  part  equal  to  pi  times 
the  sampling  rate,  and  without  a  complex-conjugate  mate.  This 
occurrence  should  not  alarm  the  designer;  the  pole  information  should 
simply  be  disregarded.  Perhaps  coincidentally,  however,  none  of  the 
designs  in  this  study  which  exhibited  this  characteristic  appeared  to 
be  very  useful. 

4.4.6.  As  just  mentioned,  the  locations  of  the  closed-loop  poles 
of  the  regulator  are  provided  by  CGTPIV.  By  observing  this 
information,  it  was  possible  to  determine  that,  by  use  of  implicit 
model -following  design  techniques,  the  locations  of  these  poles  can  be 
influenced  by  the  designer  to  a  much  greater  degree  than  by 


conventional,  or  "explicit"  regulator  design.  This  capability  was  very 
useful,  and  its  significance  is  discussed  in  Section  5.6. 

4.4.7.  The  program  CGTPIV  assumes  that,  for  implicit 
model-following,  the  number  of  inputs,  outputs  and  command  model  states 
will  all  be  equal.  The  designer  may  wish  to  increase  the  number  of 
command  model  states  in  order  to  exercise  improved  control  over  the 
system.  For  example,  in  this  study,  the  addition  of  the  pitch  rate 
state  as  a  modelled  output  was  useful  in  achieving  control  over  the 
initial  speed  of  the  regulator.  It  was  not  possible  to  invent  a  new 
control  to  allow  the  dimensionality  restrictions  to  be  met,  and  the 
result  was  a  rank  deficiency  in  the  partitioned  matrix  which,  when 
inverted,  produces  the  n  matrix  of  (11-22)  and  (A— 2 1 ) .  The  use  of  a 
pseudoinverse  was  therefore  required. 

The  use  of  a  matrix  pseudoinverse  in  this  situation  is  analogous 
to  the  use  of  the  left  inverse  (a  pseudoinverse)  in  achieving  a 
"least-squares"  solution  to  an  over-determined  set  of  linear  equations. 
Rather  than  achieve  an  exact  solution,  which  does  not,  in  general, 
exist,  the  sum  of  the  squared  error  terms  is  minimized.  This  results 
in  a  unique,  minimum-norm  approximation  to  the  solution  [  30].  If  it 
were  desired  in  such  a  case  to  have  the  approximation  be  more  accurate 
for  especially  critical  components,  a  "weighted"  pseudoinverse  could  be 
used  in  the  solution  [30].  The  use  of  such  a  weighted  pseudoinverse 
has  not  been  implemented  in  CGTPIV,  so  the  user  has  no  input  for 
specifying  which  elements  of  the  resulting  n  matrix  will  be  determined 
most  accurately.  The  situation  does  not  in  any  way  alter  the  design 
procedure.  However,  design  of  an  acceptable  controller,  based  on  the 
unweighted  pseudoinverse,  may  be  more  difficult,  or  even  impossible. 


In  this  study,  regulator  design  was  possible  under  these  conditions, 
but  CGT  designs  based  on  the  pseudoinverse  were  unacceptable.  Means  of 
dealing  with  this  problem  are  discussed  in  Section  5.5. 

4.5  Summary 

This  chapter  outlined  the  specific  design  objectives  and  analysis 
methods  employed  in  this  study.  Basic  insights  gained  while  conducting 
designs  through  the  use  of  implicit  model-following  were  presented.  In 
the  chapter  that  follows,  the  use  of  implicit  model-following,  based  on 
these  insights,  will  be  shown  to  provide  a  means  of  enhancing  the 
ability  of  the  designer  to  influence  the  characteristics  and 
capabilities  of  the  control  system. 


V.  Analysis  of  Design  Results 

5.1  Introduction 

This  chapter  presents  the  results  of  the  design  efforts  of  this 
study.  The  baseline  controller  design  is  defined  and  then  analyzed  in 
detail;  this  controller  is  shown  to  have  little  capability  in  tests 
using  realistic  truth  models  which  include  actuator  rate  and  position 
limits  or  higher-order  actuator  dynamics.  The  primary  concern  during 
the  actual  progress  of  the  design  effort  described  was  to  produce  a 
controller  that  would  function  well  in  spite  of  the  actuator  position 
and  rate  limits.  The  logic  and  design  path  followed  in  achieving  that 
goal  are  presented  as  a  means  of  introducing  the  various  alternate 
designs;  controllers  based  on  the  standard  PI  regulator  formulation  are 
discussed,  followed  by  designs  that  used  implicit  model-following  to 
try  to  improve  on  the  baseline  performance  with  respect  to  actuator 
limitations.  The  robustness  of  these  designs  with  regard  to 
higher-order  actuator  dynamics  and  design  model  parameter  variations  is 
then  discussed.  Finally,  direct  modification  (via  "anti-windup" 
methods)  of  the  control  law  to  compensate  for  nonlinearities  is 
addressed  as  a  complementary  means  of  achieving  design  objectives.  The 
discussion  has  been  limited  to  13  controller  designs  chosen  from  among 
the  dozens  of  alternative  potential  controllers  that  were  considered. 
The  designs  selected  were  chosen  either  because  they  were  the  best  with 
regard  to  a  particular  design  objective,  or  simply  to  demonstrate  a 
point  about  the  design  technique  or  characteristics.  An  attempt  has 
been  made  to  keep  the  number  of  plots  presented  to  the  minimum 
necessary  to  provide  insight  into  the  relative  capabilities  and 


limitations  of  the  different  designs  and  the  design  methods  used.  The 
tables  and  the  singular  value  and  time-response  simulation  plots 
referred  to  herein  have  been  placed  together  at  the  end  of  the  chapter 
to  make  the  text  easier  to  read.  The  reader  is  once  again  referred  to 
Appendix  E  for  information  on  what  aspects  of  the  contents  of  this 
chapter  were  affected  by  the  error  found  in  the  design  software. 

5.2  The  Baseline  Controller 

In  order  to  evaluate  the  potential  of  PI  regulator  designs 
developed  by  means  of  implicit  model -following,  a  baseline,  or  standard 
for  comparison,  was  needed.  The  AFTI  F-16  pitch  pointing  CGT/PI  design 
by  Floyd  [16],  based  on  the  five-state  design  model  defined  in  Section 
4.2,  was  chosen  to  fill  this  role.  This  design,  henceforth  referred  to 
as  SR-B  (Standard  Regulator-Baseline),  was  duplicated  using  the  program 
CGTPIV.  References  [ 1 6  and  34]  contain  detailed  explanations  of  this 
design  software  as  well  as  user  instructions;  Appendix  D  documents 
minor  changes  in  the  program  version  used  herein  and  includes  a  sample 
execution  of  the  program.  For  the  regulator  design,  quadratic  weights 
of  200  were  placed  on  output  (pitch  and  flight  path  angle)  deviations 
(matrix  Y  of  (A-39)),  weights  of  1  each  on  the  inputs  and  input  rates 
(matrices  tl.  and  U_  of  (A-39),  respectively),  and  an  additional  weight 
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of  50  was  manually  inserted  as  the  (3*3)  element  of  the  resultant  state 
weighting  matrix  (X  matrix  of  (A-40))  to  penalize  and  thus  limit  the 
pitch  rate  magnitude.  No  "implicit’’  weights  were  used.  For  the  CGT,  a 


two  state  command  model  was  used: 


The  command  model  was  chosen  to  represent  the  ideal  output  character¬ 
istics  of  decoupled,  first-order  responses  for  the  pitch  and  flight 
path  angles,  which  were  the  system  outputs,  to  command  inputs.  This 
command  model  was  the  standard  command  model  for  all  CGT  designs  that 
are  discussed  in  this  chapter.  The  design  weights  and  resulting 


controller  gains,  as  defined  in  (11-25)  and  (11-26),  for  SR-B  are 
summarized  in  Table  V-1. 

Figure  V-1  shows  the  response  of  the  regulator  to  an  initial 
condition  of  1  degree  in  the  pitch  angle  state  and,  therefore,  in  both 
of  the  outputs,  recalling  (IV-5)  and  (IV-6).  So  that  repeated 
definition  will  not  be  required,  all  references  to  initial  conditions 
of  a  given  magnitude  in  the  remainder  of  this  thesis  are  likewise 
intended  as  an  initial  condition  of  that  magnitude,  in  degrees,  applied 
to  the  pitch  angle  state;  both  outputs  therefore  begin  at  a  value  of 
that  magnitude.  The  time-response  plot  was  produced  using  the  program 
ODEACT  (documented  in  Appendix  C)  with  the  linear  design  model  as  a 
truth  model;  it  is  identical  to  the  terminal  plot  generated  by  CGTPIV. 
On  this  and  on  subsequent  time-response  plots,  symbol  "I"  represents 


the  pitch  angle,  symbol  "2"  the  flight  path  angle,  "3"  is  the  position 
of  the  horizontal  tail  and  "4"  is  the  position  of  the  trailing  edge 
flap.  With  the  plot  held  so  that  the  title  can  be  read,  time  (in 
seconds)  is  depicted  on  the  horizontal  axis  and  the  values  (in  degrees) 
associated  with  the  symbols  are  scaled  separately  on  the  vertical  axis. 
This  regulator  was  very  fast,  with  a  rise  time  of  0.12  seconds,  and 
produced  an  overshoot  of  the  final  value  of  about  40$  in  the  pitch 
angle  and  15$  in  the  angle  of  attack.  Note,  however,  that  the  initial 
rate  of  movement  of  both  control  surfaces  was  far  in  excess  of  the 
actual  rate  limits  of  the  actuators,  and  that  the  maximum  deflection  of 
the  trailing  edge  flap  exceeded  the  actuator  position  limit  (these 
limits  were  defined  in  Section  4.3). 

Figure  V-2  shows  the  response  of  the  CGT/PI  for  this  design,  with 
the  same  linear  truth  model,  to  a  step  input  of  1  degree  in  pitch. 
Again,  to  avoid  repetition,  this  and  all  subsequent  references  to  CGT 
command  inputs  are  to  be  interpreted  as  step  input  commands,  in 
degrees,  to  the  pitch  angle  output  only.  The  model  following  was 
excellent.  The  pitch  angle  response  approximated  that  of  the  CGT 
command  model  ~  a  first-order  lag  with  a  settling  time  of  less  than 
one  second.  The  ideal  flight  path  angle  response  would  have  been  to 
remain  at  zero;  the  actual  maximum  error  was  about  0.07  degrees,  with 
rapid  regulation  to  zero.  Both  outputs  achieved  the  desired  model 
response  steady-state  values.  However,  the  initial  rate  of  movement  of 
the  horizontal  tail  surface  exceeded  the  actuator  rate  limit. 

The  program  ODEACT  was  next  used  to  conduct  a  more  realistic 
simulation  analysis  of  the  controller.  Some  of  the  results  of  that 
*  analysis  are  included  in  Table  V-2.  The  table  summarizes  the  results 


discussed  in  this  section  and  also  provides  some  data,  not  specifically 
mentioned  in  the  text,  which  is  useful  in  comparing  the  effects  of  the 
various  perturbations  on  this  design  as  well  as  designs  to  be  discussed 
later.  Figure  V-3  shows  the  response  of  SR-B  to  an  initial  condition 
of  magnitude  0.1  in  both  outputs,  with  respect  to  a  nonlinear  truth 
model  created  by  adding  actuator  rate  and  position  limits  to  the 
single-state  (design  model)  actuator  model.  Even  with  this  very  small 
initial  condition,  the  regulator  showed  signs  of  degradation  due  to 
actuator  saturation;  the  pitch  angle  overshot  by  nearly  50£.  With  an 
initial  condition  of  0.5  degrees,  the  regulator  was  unstable.  Figure 
V-4  shows  the  CGT/PI  response  to  a  unit  step  input  using  the  nonlinear 
single-state  actuator  model.  At  this  level  of  input  there  was  very 
little  degradation  in  response,  but  with  an  input  magnitude  of  two 
degrees,  the  controller  became  unstable  with  the  nonlinear  truth  model. 

The  instability  of  SR-B  demonstrates  a  common  effect  of  actuator 
position  or  rate  saturation  in  PI  controllers,  referred  to  as  "windup" 
[30].  When  a  large  change  in  setpoint  is  desired,  the  proportional 
channel  of  the  regulator  can  saturate  the  actuators;  meanwhile,  the 
integral  channel  begins  to  integrate  large  errors.  Eventually,  the 
integral  channel  will  reach  a  level  at  which  it  can  saturate  the 
actuators  by  itself;  the  overall  PI  regulator  command  level  will  remain 
high  until  after  the  error  in  the  output  has  changed  sign,  allowing  the 
integral  channel  to  "discharge".  This  is  unlike  a  pure  proportional 
gain  controller  which  reduces  its  commanded  control  as  soon  as  the 
errors  come  out  of  the  saturating  region.  The  result  of  saturation  in 
the  PI  regulator  can  be  large  overshoots  or,  as  seen  here,  instability 
[30].  In  the  case  of  the  CGT/PI,  the  problem  is  amplified  when  the 


feedforward  controls  contribute  to  actuator  saturation.  While  other 
means  of  compensating  for  this  phenomenon  are  available  [30]  and  will 
be  discussed  in  Section  5.7#  an  attempt  to  design  around  the  problem 
using  implicit  model-following  was  pursued  initially. 

An  important  question  to  be  addressed  at  this  point  is  "how  large 
an  initial  condition  must  the  regulator  be  able  to  manage  in  order  to 
be  considered  satisfactory?"  The  answer  depends  in  part  on  the  method 
used  to  simulate  the  onset  of  the  initial  condition.  Both  ODEACT  and 
CGTPIV  use  a  very  harsh  method,  which  assumes  that  the  system  is 
totally  relaxed  (all  states  at  zero)  and  that  the  states  to  which 
initial  conditions  are  assigned  are  then  instantaneously  changed.  The 
(perhaps  more  realistic)  alternative  to  this  method  would  be  to  apply 
the  changes  in  states  over  a  sequence  of  sample  periods,  transitioning 
from  a  steady-state  condition  to  the  new  condition  at  a  realistic  rate 
that  allows  the  controller  to  begin  to  respond  during  the  transition 
period.  Consider  a  1  degree  change  in  pitch  at  the  design  flight 
condition;  causing  this  to  occur  in  one  sample  period  (.02  seconds) 
represents  a  turn  rate  of  50  degrees  per  second,  which  is  the  equiva¬ 
lent  of  a  level  turn  at  about  25  g’s.  Obviously,  such  a  change  in 
pitch  through  pure  rotation  (thus  not  requiring  such  a  large  transla¬ 
tional  acceleration)  could  occur  due  to  gusts,  or  the  effect  duplicated 
by  sensor  errors  or  computer  malfunction;  the  point  is  that  an  initial 
condition  of  1  degree  for  the  simulation  method  being  used  is  not 
insignificant.  The  approach  taken  in  this  study  was  to  explore  the  use 
of  implicit  model-following  as  a  means  to  achieve  regulator  designs 
that  would  handle  larger  initial  conditions  than  those  which  desta¬ 
bilized  the  baseline,  SR-B;  the  larger  the  better.  The  goal  was  to 


examine  the  capability  of  Implicit  model-following  design  techniques. 
Similarly,  since  current  flight  control  systems  being  used  in  the  AFTI 
F-16  are  capable  of  decoupled  pitch-pointing  angles  of  up  to  approxi¬ 
mately  3  degrees  [2],  that  capablity  was  estabished  as  the  design 
objective  for  the  CGT/PI. 

Figure  V-5  shows  the  response  of  SR-B  to  an  initial  condition  of  1 
degree  with  a  truth  model  simulation  employing  the  three-state  linear 
actuator  model  described  in  Section  4.3;  Figure  V-6  shows  the  response 
using  the  four-state  linear  actuator  model.  Notice  that  the  increased 
order  of  actuator  dynamics  caused  the  initial  overshoot  in  both  outputs 
to  increase.  Note  also  the  oscillations  in  the  control  surfaces  and 
outputs,  and  that  the  resulting  degree  of  degradation  was  clearly 
unacceptable  in  the  four-state  simulation.  Designing  to  avoid  this 
problem,  the  effect  of  a  "high  frequency"  perturbation,  became  another 
of  the  goals  for  Implicit  model-following. 

The  results  with  nonlinear  (saturating)  higher-order  actuator 
models  were  predictably  worse;  the  CGT/PI  was  unstable,  with  even  a 
unit  step  input,  using  the  three-state  nonlinear  actuators,  due  to  the 
combined  effects  of  actuator  dynamics  and  nonlinearities.  Again,  this 
performance  was  considered  unacceptable,  and  a  candidate  for  improve¬ 
ment  through  implicit  model-following. 

The  SR-B  regulator  was  also  evaluated  against  the  additional 
linear  truth  models  defined  in  Section  4.3  which,  while  of  the  same 
dimension  as  the  design  model,  simulated  either  erroneous  design  model 
parameters  or  large  changes  in  flight  conditions.  The  first  such 
truth  model  was  developed  using  selected  stability  derivatives  (Za,  Ma 
and  M  ,  as  described  in  Section  4.3)  which  were  20*  larger  than  the 
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design  model  values;  this  perturbation  produced  no  noticeable 
degradation.  The  next  truth  model  represented  a  different  flight 
condition  —  .6  mach  at  20,000  feet.  The  regulator  was  degraded,  but 
stable,  as  shown  in  Figure  V-7.  The  final  truth  model  represented 
flight  conditions  at  .6  mach  and  30,000  feet;  the  level  of  degradation 
was  much  more  severe,  but  the  regulator  was  still  stable  (Figure  V-8). 
The  differences  in  vertical  scales  of  these  plots  is  significant  to 
note  in  comparing  the  size  of  the  overshoots. 

An  analysis  of  the  minimum  singular  values  of  the  inverse  return 

difference  function  of  this  controller  was  conducted  using  the  program 

CGTSVD  (documented  in  Appendix  B).  The  singular  value  plots  are  shown 

in  Figures  V-9,  V-10  and  V— 1 1 •  Each  plot  covers  two  decades  of  radian 

frequency,  labeled  (when  the  page  is  turned  so  that  the  figure  title 

can  be  read)  across  the  bottom  of  the  plot.  The  symbol  "1"  represents 

the  logarithm  of  the  maximum  singular  value  of  the  function  at  each 

frequency,  and  the  symbol  "2"  represents  the  logarithm  of  the  minimum 

singular  value;  the  two  values  are  scaled  together,  as  indicated  by  the 

labels  at  the  right  edge  of  each  plot.  Note  that  the  scales  vary 

between  plots.  A  summary  of  the  minimum  singular  values  (converted  to 

actual  magnitude)  at  various  frequencies  is  included  in  Table  V-3. 

This  table  also  shows  the  smallest  singular  value  encountered  and  the 

frequency  at  which  it  occurred  (a  ,  and  w  ).  As  stated  in  Section 

-min  £min 

3.2,  the  magnitude  of  the  minimum  singular  value  of  the  inverse  return 
difference  function  is  a  measure  of  the  robustness  of  the  controller 
with  respect  to  a  norm-bounded  but  otherwise  arbitrary  perturbation;  in 
other  words,  we  would  like  this  number  to  be  large,  especially  at  high 
frequencies  where  the  magnitude  of  uncertainty  is  usually  large.  No 
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absolute  judgment  as  to  whether  the  values  for  SR-B  are  good  or  bad  Is 
offered  at  this  point;  their  primary  significance  lies  in  comparisons 
with  other  designs. 

5.3  Alternate  Standard  Designs 

The  baseline  design  was  considered  to  be  deficient  in  terms  of 
excessive  actuator  commands  and  sensitivity  to  higher-order  actuator 
dynamics,  but  quite  robust  with  regard  to  parameter  variations.  Later 
designs  with  implicit  model-following  were  able  to  improve  in  the 
deficient  areas  through  reduction  of  output  rate  weightings  and 
increased  weights  on  control  rates.  In  order  to  conduct  an  impartial 
evaluation,  attempts  were  made  to  achieve  the  same  type  of  improvement 
using  the  standard  regulator  formulation.  Two  of  the  resulting 
designs,  SR-2  and  SR-3,  are  summarized  along  with  SR-B  in  Tables  V-1, 
V-2  and  V-3.  In  these  designs,  the  output  weightings  were  reduced  and 
input  rate  weightings  increased  to  the  maximum  extent  possible  without 
significantly  degrading  the  response  of  the  regulator  with  respect  to 
the  linear  design  model.  Only  improvement  with  regard  to  actuator 
saturation  is  discussed  at  this  point;  the  other  aspects  are  covered  in 
Section  5.6.  All  of  the  simulation  results  discussed  in  this  section 
are  with  respect  to  the  truth  model  incorporating  first-order  nonlinear 
actuators. 

The  response  of  SR-2  with  respect  to  initial  conditions  of  0.1  and 
0.5  is  shown,  respectively,  in  Figures  V-12  and  V— 1 3 •  The  response  was 
somewhat  degraded  at  the  larger  initial  condition,  but  was  obviously  an 
improvement  over  SR-B,  which  was  unstable  under  the  same  conditions. 
SR-2  remained  stable  for  initial  conditions  of  up  to  0.7  degrees.  For 


a  unit  step  input,  the  CGT/PI  response  was  very  similar  to  that  of 


SR-B,  which  was  depicted  in  Figure  V-4.  For  an  input  of  2  degrees, 
there  was  very  little  degradation  due  to  actuator  saturation;  with  a  3 
degree  command  input,  the  controller  remained  stable,  although  severely 
degraded  (Figure  V-14).  Again,  this  was  an  improvement  over  the 
baseline  design,  which  was  unstable  with  an  input  of  2  degrees.  The 
responses  of  SR-3  were  very  similar  to  those  of  SR-2,  and  are  therefore 
not  shown;  the  slight  improvement  in  its  performance  with  respect  to 
nonlinear  actuators  over  that  of  SR-2  is  shown  in  Table  V-2. 


5.4  Implicit  Designs  with  Two  Model  Outputs 

The  first  designs  conducted  using  an  implicit  model  in  the 
performance  index  of  the  PI  regulator  were  based  on  a  two-state 
regulator  command  model.  Since  the  number  of  actual  system  outputs  was 
equal  to  the  number  of  model  states,  this  was  the  normal  mode  for  the 
design  software  being  used.  Some  liberty  was  taken  in  using  different 
command  models  in  the  regulator  design  than  the  one  used  in  CGT  design. 
Three  regulator  command  models  were  used  for  the  designs  discussed  in 
this  section,  all  of  the  form 


(V-4 ) 

( V— 5 ) 

(V-6) 


The  diagonal  form  for  the  command  model  dynamics  matrix  was  chosen 


because  decoupling  of  the  pitch  and  flight  path  angle  responses  was 
desired.  Also,  it  was  hoped  that  this  would  contribute  to  the 
orthogonality  of  the  eigenvectors  of  the  resulting  closed-loop  system. 

The  first  design  used  the  same  command  model  as  the  standard  CGT 
command  model,  i.e.,  P  =  5.  The  weightings  used  and  gains  which 
resulted  for  this  design,  referred  to  as  IMF2-1  (Implicit 
Model-Follower,  2-state  command  model,  design  number  1),  and  subsequent 
two-state  command  model  designs  are  given  in  Table  V-4.  Performance 
results  are  summarized  in  Table  V-5;  references  to  rise  time  in  this 
section  are  based  on  operation  under  design  conditions,  as  given  in 
that  table.  The  singular  values  and  regulator  pole  locations  are  given 
in  Table  V-6.  Once  again,  the  discussion  in  this  section  centers  on 
the  effort  to  design  around  the  actuator  saturation  problem;  the 
evaluation  of  these  designs  with  respect  to  other  criteria  is  reserved 
for  Section  5.6.  All  of  the  simulations  discussed  in  this  section  were 
conducted  using  the  single-state  nonlinear  actuator  model. 

IMF2-1  was  not  a  great  improvement  over  the  standard  regulators. 
Even  though  the  weightings  on  the  output  rate  deviations  were  less  than 
the  corresponding  weights  on  output  deviations  for  the  earlier  standard 
regulator  designs,  these  weights  were  transformed  by  (A-45a)  to  produce 
very  high  state  weightings  —  greater  in  some  cases  by  an  order  of 
magnitude  over  the  standard  regulator  designs.  The  result  was,  again, 
short  rise  time.  Figures  V— 1 5  and  V— 1 6  show  the  response  of  IMF2-1  to 
initial  conditions  of  0.1  and  0.5  degrees,  respectively.  As  with  SR-2 
and  3»  there  was  little  degradation  at  the  smaller  initial  condition; 
the  larger  initial  condition  caused  greater  degradation,  but  not 
instability.  The  CGT/PI  response  to  a  unit  step  input  was  much  the  same 


as  the  standard  formulation  designs.  The  response  with  a  commanded 
input  of  3  degrees  was  an  improvement,  however,  as  shown  by  comparison 
of  Figure  V-17  to  Figure  V-14. 

IMF2-2  was  an  attempt  to  slow  down  the  initial  response  of  the 
regulator  by  changing  the  command  model  to  P  =  2.  This  path  was  chosen 
to  limit  the  rate  of  increase  in  control  inputs  to  the  actuators,  and 
thus  reduce  the  effects  of  the  discrepancy  between  the  actuator  rate 
capability  of  the  nonlinear  actuator  model  and  that  of  the  linear 
design  model.  It  was  hoped  that  this  would  reduce  the  amount  of 
degradation  due  to  actuator  rate  saturation.  As  shown  in  subsequent 
designs,  slowing  down  the  regulator  in  such  a  manner  was  effective,  and 
tended  to  reduce  the  effects  of  the  nonlinear  actuator  position  limits, 
as  well.  However,  the  quadratic  weightings  used  in  IMF2-2  were  the 
same  as  for  IMF2-1,  so  the  state  weightings  were  still  quite  high,  and 
there  was  not  a  significant  difference  in  the  speed  of  the  regulator  or 
in  the  magnitude  or  rate  of  control  surface  movement  (with  a  linear 
truth  model)  from  that  of  the  previous  design.  The  response  to  a  small 
initial  condition  (0.1)  is  shown  in  Figure  V-18,  with  the  regulator 
displaying  less  of  a  tendency  to  overshoot  than  IMF2-1,  as  seen  by 
comparison  with  Figure  V— 1 5 •  The  regulator  remained  stable  for  initial 
conditions  of  up  to  0.9  degrees.  The  CGT/PI  response  to  a  unit  step 
input  was  similar  to  previous  designs,  but  the  pitch  angle  did 
overshoot  the  commanded  value  by  a  small  amount,  as  shown  in  Figure 
V-19.  However,  unlike  the  response  of  IMF2-1  shown  in  Figure  V-17, 
there  was  no  increase  in  the  percentage  of  overshoot  of  the  CGT/PI 
pitch  angle  when  the  command  was  increased  to  3  degrees. 

IMF2-3  incorporated  both  the  slower  command  model  and  reduced 


quadratic  weights  on  the  output  rates,  as  shown  in  Table  V-4.  An 
increase  was  also  made  in  the  weights  placed  on  the  input  rates.  As  a 
result,  significant  differences  became  apparent  between  this  and 
previous  designs.  Because  of  the  changes  in  quadratic  weights,  the 
initial  response  of  the  regulator  was  slower,  with  a  rise  time  of  0.1 6 
seconds,  and  produced  smaller  control  inputs.  For  this  reason  it  was 
able  to  remain  stable  with  an  initial  condition  of  1.1  degrees, 
although  it  was  certainly  degraded  in  performance  at  that  level. 

Figure  V-20  shows  the  response  to  an  initial  condition  of  1  degree. 

The  CGT/PI  response  to  a  unit  step  input  was  similar  to  that  of  IMF2-2 
(which  was  shown  in  Figure  V— 19) *  for  an  input  of  3  degrees,  the 
overshoot  was  equal  in  magnitude  to  that  of  IMF2-1  (which  was  shown  in 
Figure  V-17),  but  subsequent  recovery  was  slower,  as  shown  in  Figure 
V-21 . 

IMF2-4  incorporated  even  lower  weights  on  the  output  rates  and 
higher  weights  on  the  input  rates,  with  a  continued  performance 
improvement  relative  to  actuator  saturation.  Rise  time  increased  to 
0.18  seconds,  and  as  shown  in  Figure  V-22,  the  response  to  an  initial 
condition  of  1  degree  was  better  than  with  any  previous  designs.  The 
regulator  remained  stable  with  initial  conditions  of  up  to  1.5  degrees 
The  CGT/PI  response  to  a  unit  step  input  was  similar  to  the  earlier 
designs.  As  shown  in  Figure  V-23»  however,  the  pitch  angle  overshoot 
in  the  CGT/PI  response  with  a  large  (3  degree)  input  was  greater,  and 
recovery  more  prolonged,  due  to  the  slower  regulation  of  errors. 

IMF2-5  used  weights  similar  to  those  of  the  previous  design  and 
used  an  even  slower  command  model,  with  P  =  1.5,  as  a  test  of  how  an 
extremely  slow  regulator  would  perform.  The  response  of  the  regulator 


to  a  small  initial  condition  (0.1)  is  shown  in  Figure  V-24;  its  rise 
time  was  the  same  as  that  of  IMF2-4  (Table  V-5)  but  the  regulation  of 
the  pitch  angle  after  the  initial  overshoot  was  slower.  This  regulator 
was  stable  with  initial  conditions  of  up  to  1.7  degrees,  although  with 
an  initial  condition  of  1  degree,  the  overshoot  in  pitch  angle  was 
greater  (170$  versus  130$)  than  for  IMF2-4.  The  CGT/PI  response  to  a 
unit  step  input  is  shown  in  Figure  V-25.  In  this  case,  the  level  of 
input  was  such  that  actuator  saturation  was  not  yet  a  factor,  but  the 
overshoot  was  larger,  and  the  subsequent  correction. was  slower,  than  in 
previous  designs.  With  larger  commands,  and  the  onset  of  saturation, 
the  effect  was  amplified.  Since  the  regulator  for  this  design 
represented  no  real  improvement  over  IMF2-4  and  the  CGT/PI  was 
degraded,  IMF2-5  was  felt  to  represent  the  practical  limit  to  which  the 
regulator  could  be  slowed,  by  the  use  of  a  slow  regulator  command 
model,  without  creating  an  unacceptable  design. 

It  was  seen  in  this  section  that  implicit  model-following  could  be 
used  to  enhance  the  capability  of  the  controller  to  perform  with 
nonlinear  actuators  subject  to  position  and  rate  saturation.  This  was 
accomplished  by  slowing  down  the  initial  response  of  the  regulator,  as 
characterized  by  rise  time.  The  desired  effect  was  achieved  by  using 
lower  quadratic  weights  on  the  output  rates  in  conjunction  with  higher 
weights  on  the  input  rates,  as  well  as  a  slower  regulator  command 
model.  As  the  rise  time  of  the  successive  designs  increased,  the 
ability  of  the  regulators  to  perform  well  and  remain  stable  with  larger 
initial  conditions  improved,  as  summarized  in  Table  V-5.  However,  as 
the  regulator  speed  decreased,  the  precision  of  the  CGT/PI  response  to 
command  inputs  was  degraded  slightly. 


5.5  Implioit  Designs  with  Three  Model  Outputs 

Designs  using  a  three  state  command  model  for  the  regulator  were 
undertaken  in  an  attempt  to  achieve  more  control  over  the  system's 
closed-loop  characteristics.  In  any  design,  the  degree  to  which  full 
eigenstructure  assignment  can  be  achieved  is  ultimately  limited  by  the 
number  of  outputs  and  controls  available.  If  the  controlled  system  has 
r  Independent  controls  and  p  independent  outputs  available  for 
feedback,  then  at  most  max(r,p)  eigenvalues  may  be  assigned  and 
min(r,p)  entries  of  max(r,p)  closed-loop  eigenvectors  may  be  assigned 
[1].  Increasing  the  number  of  outputs  in  the  design  model  was  not  a 
problem  in  this  case  since  all  states  were  assumed  available,  but  there 
was  no  way  to  increase  the  number  of  controls.  The  pitch  rate  was 
chosen  as  the  third  output  to  provide  a  means  of  directly  controlling 
the  speed  of  the  response,  and  a  corresponding  third  state  was  added  to 
the  regulator  and  CGT  command  models,  which  became 
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Again,  the  diagonal  form  for  the  regulator  command  dynamics  matrix  was 


initially  chosen  to  attempt  to  enhance  the  orthogonality  of  the 
closed-loop  system  eigenvectors.  For  the  CGT  command  model,  was  set 
to  zero,  as  was  the  (3*3)  element  of  the  model  output  matrix,  so  that 
the  effective  model  was  the  same  as  for  the  earlier  designs,  but  with 
the  CGTPIV  dimensionality  restrictions  met. 

As  mentioned  in  Section  4.4.7,  the  CGTPIV  software  requires  that 
the  number  of  controls  and  outputs  be  equal.  In  conducting  a  design 
when  this  is  not  really  the  case,  either  the  design  model  control  or 
output  matrix  will  be  rank-defective.  The  entire  design  result  is 
thereby  based  on  an  unweighted  matrix  pseudoinverse  (the  program  output 
announces  this  by  stating  that  the  II  matrix  is  rank-defective).  If  the 
number  of  controls  is  less  than  the  number  of  outputs,  then  a  true 
solution  will  only  be  achieved  in  a  least-squares  sense.  The  designer 
can  still  exercise  a  great  deal  of  control  over  the  performance  of  the 
resulting  regulator  by  iteratively  changing  the  weightings  used  in  its 
design;  there  is  no  corresponding  means  of  compensation,  however,  to 
influence  the  design  of  the  CGT.  The  result  in  this  case  was  that  the 
regulator  designs  were  relatively  successful  in  that  they  produced 
acceptable  performance  with  more  conservative  control  surface  commands; 
but  the  CGT  designs  were  all  unsatisfactory  in  that  the  feedforward 
gains  were  too  high,  resulting  in  excessive  commands  to  the  actuators. 
All  of  the  CGT  designs  conducted  with  the  rank-defective  II  matrix 
exhibited  performance  degradation,  with  even  a  unit  step  input,  when 
evaluated  using  the  nonlinear  single-state  actuator  model.  This  was 
true  even  though  the  CGT  command  model  used  employed  P^  =  0  and 
C(3»3)  =  0,  thus  preventing  any  feedforward  control  from  being 
generated  based  on  the  added  model  state.  Subsequent  study  showed  that 


the  regulators  discussed  in  this  section  could,  however,  be  used  in 
conjunction  with  the  CGT  designs  of  the  preceding  section,  provided  the 
regulator  response  was  reasonably  similar  to  that  of  the  regulator  upon 
which  the  CGT  design  was  based.  Controllers  defined  in  such  a  manner 
are  discussed  at  the  end  of  this  section. 

The  CGT/PI  designs  discussed  in  this  section  are  summarized  in 
Tables  V-7,  V-8  and  V-9.  Note  that,  unlike  previous  performance 
summaries.  Table  V-8  does  not  indicate  the  level  of  Initial  condition 
required  to  produce  a  lOOJt  overshoot;  this  is  because  the  onset  of 
actuator  degradation  due  to  saturation  was  always  within  0.5  degrees  of 
the  maximum  stable  initial  condition.  Once  again,  the  presentation  at 
this  point  will  center  on  the  attempt  to  alleviate  the  actuator  satura¬ 
tion  problem;  all  simulations  are  with  respect  to  the  single-state 
nonlinear  actuator  model. 

Design  IMF3-1  was  based  on  a  regulator  command  model  with 
P1  s  P2  s  5*  P3  =  10,  and  what  would  seem  to  be  a  light  weight  on  the 
pitch  rate's  rate  deviations  (0.1).  These  initial  values  of  and  P2 
were  chosen  to  correspond  to  the  regulator  command  model  used  for  the 
first  designs  of  the  earlier  IMF2  class.  The  larger  value  for  P^  was 
found  to  be  needed  to  achieve  a  response  with  reasonable  speed 
characteristics.  Likewise,  the  small  weight  on  the  pitch  rate 
derivative  was  chosen  as  a  result  of  trial-and-error  attempts  using  a 
larger  value,  which  produced  an  excessively  slow  regulator.  This 
regulator's  response  to  an  initial  condition  of  1  degree  in  pitch  and 
flight  path  angle  is  shown  in  Figure  V-26,  and  demonstrates  just  how 
great  an  effect  the  additional  model  state  had  on  the  speed  of  the 
regulator;  the  rise  time  was  0.62  seconds,  as  compared  to  0.18  seconds 


for  the  slowest  regulator  in  the  IMF2  class.  There  was  no  noticeable 
degradation  due  to  actuator  saturation  for  initial  conditions  up  to  6 
degrees;  and  stability  was  maintained  for  initial  conditions  up  to  6.5 
degrees.  However,  it  was  felt  that  the  response  of  this  regulator  was 
too  slow  for  adequate  performance  in  a  fighter  aircraft  flight  control 
system. 

IMF3-2  employed  a  faster  command  model  (P^  =  p2  s  10»  **3  =  ^5)  and 
an  even  lower  weight  on  the  pitch  rate's  rate  deviations  (0.01)  in  an 
effort  to  achieve  a  faster  response.  This  was  achieved  without  any 
degradation  due  to  actuator  saturation,  at  least  with  an  initial 
condition  of  1  degree,  as  shown  in  Figure  V-2 7.  The  rise  time  was 
reduced  to  0.32  seconds;  the  price  of  the  improvement  was  that  this 
regulator  could  withstand  smaller  initial  conditions  than  IMF3-1  —  a 
maximum  of  2.5  degrees. 

IMF3-3  differed  from  its  predecessor  by  virtue  of  a  regulator 
command  dynamics  matrix  with  an  off-diagonal  term  (Table  V-7)  and  a 
decrease  in  the  pitch  angle  output  rate  weighting.  The  purpose  of  the 
non-diagonal  command  dynamics  matrix  was  to  investigate  the  effect  of 
recognizing  and  allowing  a  degree  of  coupling  of  the  pitch  state  with 
its  derivative.  Full  recognition  of  the  physical  relationship  between 
the  pitch  and  pitch  rate  states  could  have  been  realized  by  addition¬ 
ally  setting  s  0,  but  this  would  have  represented  a  radical 
departure  from  the  stated  design  philosophy  of  attempting  to  orthogona- 
lize  the  closed-loop  system  eigenvectors  through  the  use  of  implicit 
model-following  with  a  diagonal  regulator  command  dynamics  matrix.  At 
this  point,  only  a  small  departure  was  desired,  since  the  effect  on 
performance  and  robustness  had  not  been  determined.  There  was  nothing 


inherently  wrong  with  the  response  of  IMF3-3,  but  many  other  structures 
for  the  command  dynamics  matrix  were  also  possible,  each  representing 
different  types  and  degrees  of  coupling  among  the  outputs.  Since  no 
insight  was  readily  available  to  indicate  which  of  such  structures 

(other  than  the  use  of  the  diagonal  form)  might  produce  beneficial 

results,  further  investigation  with  the  non-diagonal  regulator  command 
dynamics  matrix  was  felt  to  be  beyond  the  scope  of  this  study. 

However,  such  an  investigation  could  be  a  fruitful  area  for  future 

research.  ' 

The  design  using  the  non-diagonal  command  dynamics  matrix  was 
originally  attempted  using  the  same  output  rate  weightings  as  had  been 
used  for  IMF3-2.  The  pitch  angle  overshoot  for  the  resulting 
regulator's  response  to  initial  conditions  was  25%,  compared  to  5%  for 
IMF3-2;  and  the  response  was  poorly  damped,  resulting  in  repeated 
overshoots  of  the  pitch  angle  steady -state  value.  To  alleviate  this 
condition,  the  weight  on  the  pitch  angle  output  rate  was  reduced,  as 
shown  in  Table  V-7,  to  produce  the  final  IMF3-3  design.  Its  response 
to  an  initial  condition  of  1  degree  is  shown  in  Figure  V-28;  the 
response  was  slightly  slower  than  that  of  IMF3-2,  shown  in  Figure  V-27, 
and  the  pitch  angle  overshoot  was  about  15)1.  While  this  overshoot  was 
greater  than  for  the  other  IMF3  designs,  it  was  less  than  for  any  of 
the  standard  regulator  and  IMF2  designs. 

Many  attempts  were  made  to  design  a  regulator  that  would  wort  well 
with  a  CGT  design  based  on  the  rank-defective  n  matrix.  Initially,  it 
was  thought  that  the  CGT  might  be  "fighting"  the  slower  regulator 
response,  thus  causing  the  excessively  large  control  inputs  through  the 
CGT;  however,  speeding  up  the  regulator  through  faster  command  models 
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and  modified  weightings  in  the  performance  index  had  virtually  no 
effect  on  the  level  of  control  input  produced  by  the  CGT/PI.  Attempts 
were  then  made  to  slow  the  regulator  down  even  further,  with  the  aim  of 
limiting  the  actuator  commands.  By  the  time  any  positive  results  were 
achieved  by  this  approach,  the  regulator  performance  was  considerably 
degraded;  even  then,  the  CGT  was  still  unsatisfactory.  Two  of  the 
"slow"  regulators  which  resulted  from  these  design  attempts  were  IMF3-4 
and  IMF3-5.  No  alteration  of  the  CGT  command  model  was  attempted.  CGT 
control  inputs  could  have  undoubtedly  been  reduced  by  using  a  slower 
CGT  command  model  (with  smaller  P  values),  but  such  a  change  would  have 
also  slowed  the  CGT/PI  response  to  command  inputs.  Such  a  result  was 
not  desired. 

IMF3-4  reverted  to  the  slower  regulator  command  model  used  for 
IMF3-1,  end  greater  penalty  was  placed  on  the  input  rates.  This  slowed 
the  regulator  down,  when  viewed  in  terms  of  both  rise  and  peak  times, 
and  reduced  regulator  control  Inputs  considerably.  The  response  to 
initial  conditions  is  shown  in  Figure  V-29;  the  shape  of  the  pitch 
response  was  somewhat  unusual  due  to  the  simultaneous  reversal  in 
motion  of  both  control  surfaces. 

IMF3-5  was  slowed  even  further  by  lower  output  rate  weights  and 
lower  input  weights.  The  results  were  a  continuation  of  the  trends 
established  by  the  previous  design.  The  irregular  response  of  the 
pitch  angle  in  recovering  from  initial  conditions  is  shown  in  Figure 
V-30;  because  of  this,  the  controller  would  be  an  unlikely  candidate 
for  final  implementation. 

As  mentioned  earlier,  none  of  the  CGT  designs  conducted  with  the 
rank-defective  n  matrix  were  suitable,  due  to  excessive  feedforward 


control  magnitudes.  However,  several  of  the  earlier  CGT  designs  based 
on  the  two-state  command  model  worked  quite  well  with  regulators 
discussed  in  this  section.  Since  the  AFTI  F-16  is  an  unstable  plant, 
an  open-loop  CGT  design  is  not  feasible.  To  design  a  CGT,  a  stabili¬ 
zing  regulator  design  must  first  be  accomplished;  then  the  CGT  design 
can  be  based  on  the  stable  plant/regulator  combination.  Thus,  a  CGT 
based  on  the  two-state  command  model  is  also  based  on  a  specific 
regulator  (of  the  IMF2  class,  in  this  case). 

Satisfactory  combinations  of  previous  CGT  designs  and  IMF3 
regulators  were  identified  by  trial-and-error,  and  generally  resulted 
when  the  initial  response  dynamics  (i.e.,  rise  time)  of  the  IMF3 
regulator  were  similar  to  those  of  the  IMF2  regulator  upon  which  the 
CGT  design  was  based.  As  an  example,  the  CGT  designed  for  controller 
IMF2-5,  which  was  the  slowest  regulator  of  its  class  (Table  V-5), 
worked  well  with  regulator  IMF3-2,  which  was  the  fastest  of  the  slower 
class  (Table  V-8).  The  response  of  this  hybrid  CGT/PI  to  a  large  step 
input  of  3  degrees  is  shown  in  Figure  V— 3 1 ,  which  indicates  very  little 
degradation  due  to  actuator  saturation.  An  example  of  a  mis-matched 
design  occurred  by  using  the  CGT  of  IMF2-2  (which,  as  shown  in  Table 
V-5,  was  considerably  faster  than  IMF2-5)  with  the  same  regulator,  as 
shown  in  Figure  V-32. 

It  was  seen  in  this  section  that  the  addition  of  the  pitch  rate 
state  as  a  modelled  output  provided  a  considerable  increase  in  the 
degree  of  control  over  the  initial  response  speed  of  the  regulator.  As 
a  result,  the  regulators  were  able  to  withstand  much  larger  initial 
conditions  than  earlier  designs,  both  in  terms  of  stability  and 
performance  degradation  due  to  actuator  saturation.  While  CGT  designs 


conducted  with  a  rank-defective  n  matrix  were  unsuitable,  the  employ¬ 
ment  of  hybrid  designs  was  shown  to  be  feasible. 

5.6  Robustness  Analysis 

In  the  preceding  sections,  the  use  of  implicit  model-following  in 
PI  regulator  design  was  shown  to  be  an  effective  means  of  limiting  the 
magnitude  and  rate  of  controller  inputs.  This,  in  turn,  helped  to 
prevent  performance  degradation  and  instability  due  to  actuator 
saturation.  In  this  section,  the  robustness  of  the  various  designs 
previously  introduced  is  characterized  further.  Each  controller  was 
evaluated  against  linear  truth  models  which  differed  from  the  design 
model  in  that  third-  and  fourth-order  actuator  dynamics  were  simulated. 
Each  controller  was  also  evaluated  against  linear  truth  models  with 
design  model  actuators,  but  with  other  system  parameters  which  varied 
from  those  of  the  design  model.  The  results  of  these  evaluations  were 
compared  to  information  obtained  through  singular  value  analysis  and 
study  of  the  regulator  pole  locations. 

The  baseline  regulator  was  previously  shown  to  be  seriously 
degraded  by  the  addition  of  higher-order  actuator  dynamics  (Figures  V-5 
and  V-6,  and  Table  V-2).  Since  the  three-  and  four-state  actuator 
models  had  complex  poles  at  a  natural  frequency  of  71.4  radians  per 
second,  it  was  thought  likely  that  the  resulting  perturbation  could  be 
characterized  as  having  a  maximum  norm  at  relatively  high  frequency, 
say  between  10  and  100  radians  per  second.  Thus,  the  designs  for  which 
the  minimum  singular  values  of  the  inverse  return  difference  were 
largest  over  this  range  were  expected  to  perform  better  with  these 
truth  models.  As  noted  in  Section  3*2,  however,  the  conservatism  of 
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this  type  of  analysis  can  vary  considerably,  primarily  as  a  function  of 
the  vector  direction  of  the  perturbation.  To  complement  the  analysis 
of  singular  values  with  techniques  of  a  more  classical  flavor,  the 
locations  of  the  closed-loop  regulator  poles  for  each  design  were 
noted.  The  higher-order  actuator  model  poles  were  relatively  far  from 
the  origin,  and  had  the  effect  of  pushing  the  complex  poles  of  the 
design  model-regulator  combination  closer  to  the  imaginary  axis.  The 
destabilizing  result  is  analogous  to  the  addition  of  such  poles  to  the 
open-loop  transfer  function  of  a  SISO  control  system  [8]. 

The  singular  values  and  pole  locations  for  the  standard  regulators 
are  summarized  in  Table  V-3.  SR-2  had  slightly  larger  singular  values 
than  the  baseline  design  over  most  of  the  frequency  range  of  interest, 
although  the  difference  was  not  large.  The  complex  regulator  poles 
were  located  slightly  further  from  the  imaginary  axis  than  those  of  the 
baseline.  The  response  of  SR-2  to  initial  conditions  with  the  linear 
four-state  actuators  was  slightly  better  than  that  of  the  baseline,  as 
shown  in  Figure  V-33.  SR-3  also  had  a  small  singular  value  advantage 
over  SR-B.  Its  complex  regulator  poles  were  closer  to  the  origin  in 
both  horizontal  and  vertical  directions,  but  were  also  further  from  the 
added  actuator  poles.  This  regulator  suffered  much  less  degradation 
with  the  higher-order  dynamics  than  the  other  two,  as  shown  in  Figure 
V-34.  It  was  noted  with  these  and  with  other  intermediate  designs  that 
the  pole  locations  varied  with  the  changes  in  quadratic  weightings  used 
to  design  the  regulator,  but  that  the  pattern  of  motion  was  not  very 
consistent.  With  each  change,  some  poles  moved  in  one  direction,  some 
in  another.  More  systematic  motion  occurred  with  implicit 
model-following  techniques,  as  will  be  seen  in  subsequent  paragraphs. 
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The  singular  values  and  pole  locations  for  the  IMF2  class  of 
controllers  are  summarized  in  Table  V-6.  The  singular  values  of  IMF2-1 
and  IMF2-2  were  nearly  identical;  both  were  slightly  better  than  the 
baseline  at  10  radians  per  second,  and  worse  at  100  radians  per  second. 
The  complex  pole  locations,  two  sets  in  this  case,  were  also  nearly 
identical.  The  location  of  the  largest  complex  poles  (nearest  the 
added  actuator  poles  and  thus  most  vulnerable  to  their  effects)  was 
better  than  the  baseline  in  that  they  were  further  from  both  the 
imaginary  axis  and  the  added  actuator  poles.  The  resulting  performance 
with  the  four-state  actuator  model  was  similar  for  these  two  designs. 
Figure  V-35  shows  the  response  of  IMF2-1,  which  was  the  more  oscilla¬ 
tory  of  the  two.  They  were  better  than  SR-B  and  SR-2,  but  slightly 
worse  than  SR-3  in  terms  of  oscillation.  The  singular  values  of  IMF2-3 
were  consistently  equal  to  or  better  than  the  baseline  over  the 
frequency  range  of  interest.  The  complex  poles  were  much  closer  to  the 
origin,  and  thus  further  from  the  added  actuator  poles.  As  a  result, 
performance  with  the  four-state  actuator  model  was  much  better  than 
earlier  designs,  as  shown  in  Figure  V-36.  The  same  trends  exhibited  by 
IMF2-3  were  continued  to  an  even  greater  extent  by  IMF2-4  and  IMF-5; 
these  regulators  suffered  only  relatively  small  increases  in  overshoot 
when  subjected  to  the  actuator  dynamics,  as  shown  for  IMF2-4  in  Figure 
V-37. 

Refer  again  to  Tables  V-3  and  V-6.  Note  that  tie  use  of  implicit 
model-following  produced  a  greater  range  of  high  frequency  singular 
values  than  did  the  standard  regulator  formulation.  This  indicates 
that  the  implicit  method  provides  the  designer  an  added  degree  of 
control  over  the  characteristics  of  the  design.  The  same  conclusion  is 


supported  by  movement  of  the  regulator  poles  In  the  Implicit 
model-following  designs.  The  value  of  P  selected  for  the  regulator 
command  model  very  nearly  determined  the  location  of  the  regulator 
poles  nearest  the  origin;  the  higher  the  weights  on  the  output  rate 
deviations,  the  more  precisely  this  was  true.  As  weights  on  the  output 
rate  deviations  were  decreased,  the  remaining  poles  moved  consistently 
toward  the  origin  (for  a  constant  P);  the  same  trend  was  followed  as 
the  weights  on  the  input  rates  were  increased.  Both  the  degree  and 
consistency  of  control  available  over  the  regulator  pole  locations  is 
significant  in  providing  the  designer  with  a  method  of  designing  around 
a  specific  problem,  as  was  the  case  with  the  higher-order  actuator 
dynamics. 

Singular  values  and  pole  locations  for  the  IMF3  class  of 
controllers  are  summarized  in  Table  V-9.  The  singular  values  for 
IMF3-1  were  smaller  than  the  baseline  regulator  over  most  of  the 
desired  frequency  range.  The  radical  location  of  the  large  complex 
poles  for  this  regulator  was  sufficient  to  cause  it  to  be  just  unstable 
when  tested  with  the  four-state  actuator  model,  as  shown  in  Figure 
V-38.  IMF3-2  had  only  slightly  larger  singular  values  than  IMF3-1,  but 
its  pole  locations  were  significantly  different.  The  large  complex 
poles  were  moved  much  nearer  the  origin  by  the  decrease  in  weight  on 
the  derivative  of  the  pitch  rate.  As  a  result,  the  regulator  was 
barely  affected  by  the  dynamics  of  the  four-state  actuator  model,  as 
shown  in  Figure  V-39.  The  singular  values  and  pole  locations  for 
IMF3-3  were  similar  to  those  of  IMF3-2;  it  was  not  degraded  by  the 
actuator  dynamics.  The  singular  values  listed  for  IMF3-4  and  IMF3-5, 
if  considered  alone,  would  have  predicted  excellent  performance  against 


a  high  frequency  perturbation.  The  relative  proximity  of  the  complex 
poles  of  these  regulators  to  the  imaginary  axis  was,  however,  enough  to 
cause  serious  performance  problems,  as  shown  in  Figures  V-tO  and  V— 4 1 . 
In  this  case,  consideration  of  the  exact  perturbation,  i.e.,  added 
poles  at  a  known  location,  was  far  more  informative  than  the  analysis 
of  singular  values. 

It  was  concluded  earlier  that  the  baseline  design  was  quite  robust 
with  regard  to  parameter  variations  to  the  design  model.  Each  of  the 
other  controllers  was  evaluated  by  use  of  the  same  alternate  linear 
truth  models  as  was  SR-B,  in  an  attempt  to  assess  their  robustness 
further.  It  was  felt  that  these  parameter  variations  could  be 
characterized  as  perturbations  which  would  have  an  effect  over  a  wide 
range  of  frequencies.  That  being  the  case,  it  was  anticipated  that  the 
overall  smallest  value  encountered  as  a  minimum  singular  value  for  the 
inverse  return  difference  function  would  be  the  best  predictor  of 
robustness,  since  it  represented  the  point  of  greatest  vulnerability. 
Reference  should  be  made  to  the  singular  value  summaries  in  Tables  V-3, 
V-6  and  V-9  during  the  discussion  that  follows. 

The  first  alternate  linear  truth  model  used  was  the  one  developed 
by  using  selected  stability  derivative  values  20 %  larger  than  in  the 
design  model.  This  model  represented  a  fairly  large  modelling  error, 
yet  none  of  the  designs  were  noticeably  degraded.  This  indicated  that 
all  of  the  designs  were  reasonably  robust  against  this  type  of  error, 
one  of  a  type  which  might  be  considered  reasonably  likely  to  occur 
physically. 

The  second  truth  model  was  one  representing  flight  dynamics  at  .6 
mach  and  20,000  feet.  For  a  control  system  which  would  normally  employ 


gain  scheduling  to  optimize  control  over  a  wide  range  of  flight 
conditions,  a  perturbation  of  this  size  would  probably  physically  only 
occur  due  to  a  catastrophic  sensor  or  computer  error;  it  is  a  harsh 
test  of  the  controller.  The  response  of  the  two  standard  regulators, 
SR-2  and  SR-3,  with  this  truth  model  was  very  similar  to  that  of  SR-B, 
which  was  shown  earlier  in  Figure  V-7.  The  responses  of  the  IMF2  class 
of  regulators  were  all  slightly  degraded  in  comparison  to  those  of  the 
standard  regulators,  with  somewhat  larger  initial  overshoots  and 
oscillations.  It  was  difficult  to  rank  them  objectively  with  a 
four-second  simulation,  although  the  performance  of  IMF2-4,  shown  in 
Figure  V-42,  was  typical  of  the  group,  and  the  data  in  Table  V-5 
provides  some  insight  into  the  rate  with  which  the  oscillations  died 
out.  The  IMF3  class  of  regulators  exhibited  a  wider  range  of 
performance  than  the  other  groups.  IMF3-1  was  hardly  even  degraded,  as 
shown  in  Figure  V-43.  IMF3-2  and  IMF3-3,  on  the  other  hand,  were 
barely  unstable  under  these  conditions,  while  IMF3-4  and  IMF3-5  were 
just  barely  stable. 

The  final  truth  model  represented  flight  conditions  at  .6  mach  and 
30,000  feet.  All  of  the  standard  regulators  remained  stable,  with 
performance  similar  to  that  already  shown  for  SR-B  in  Figure  V-8.  The 
IMF2  controllers  all  exhibited  slowly  divergent  oscillations  except  for 
IMF2-2,  which  was  barely  stable;  the  performance  within  the  group  was, 
once  again,  fairly  consistent.  Again,  a  wider  range  of  performance  was 
seen  with  the  IMF3  group.  IMF3-1  was  stable,  and  in  fact  did  rather 
well,  as  shown  in  Figure  V-44.  IMF3-2  and  IMF3-3  diverged  very 
rapidly,  while  IMF3-4  and  IMF3-5  were  just  unstable  for  this  condition. 
The  relative  results  of  the  30,000  foot  evaluation  were,  therefore. 
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consistent  with  the  one  at  20,000  feet,  but  the  effects  were  more 
severe . 

In  comparing  the  results  of  the  parameter  variation  tests  for  the 
standard  regulators  to  those  of  the  IMF2  class,  the  overall  minimum 
singular  value  encountered  seemed  to  be  a  reasonably  valid  predictor  of 
robustness,  as  had  been  anticipated.  The  overall  minimum  singular 
values  for  all  of  the  standard  regulators  (shown  in  Table  V-3)  were 
better  than  those  for  any  of  the  IMF2  controllers  (Table  V-6);  and 
unlike  the  IMF2  class,  none  of  the  standard  regulators  were  destabi¬ 
lized  by  any  of  the  parameter  variations.  Within  the  IMF2  class, 
however,  the  differences  in  the  minimum  singular  values  were  fairly 
small,  as  were  the  differences  in  the  observed  robustness  characteri¬ 
stics  of  the  designs;  the  robustness  differences  were  not  predictable 
based  on  the  minimum  singular  values,  as  shown  by  comparison  of  Table 
V-5  and  Table  V-6. 

The  results  were  even  less  clear  with  the  IMF3  class,  where  the 
range  of  minimum  singular  values  was  significantly  greater,  as  was  the 
range  of  robustness  qualities.  The  minimum  singular  value  for  IMF3-1 
was  the  greatest  for  any  design  in  either  implicit  class,  and  about 
average  when  compared  to  the  standard  regulators;  its  good  performance 
in  these  tests  was  therefore  not  surprising.  But  with  the  other  IMF3 
regulators,  those  based  on  the  faster  command  model  performed  better 
than  those  based  on  the  slower  command  model,  regardless  of  their 
minimum  singular  values.  This  result  is  a  reminder  that,  for  this  type 
of  perturbation  (an  additive  change  in  the  nominal  dynamics  matrix), 
the  perturbation  is  a  function  not  only  of  the  change  to  the  dynamics 
matrix,  but  of  the  control  law  itself.  In  fact,  for  a  change  A  A  to 
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the  nominal  dynamics,  and  using  K(s)  to  represent  a  continuous-time 
control  law,  the  norm  of  an  equivalent  multiplicative  perturbation  as 


presented  in  Section  3*3  could  easily  be  calculated. 

Since 

KG'  =  (I  +  L)  KG  (III-7) 

and  here 

G(s)  =  (si  -  A) _1B  (V-10) 

G'(s)  =  (si  -  [A  +  AA])_1B  (V-11 ) 

we  have 

K(s)G'(s)  s  [I  ♦  L(s)]K(s)G(s)  (V-12) 

K(s)[s:  -  (A  ♦  A A) ]~^B  *  [I  ♦  L(s)]K(s)[sI  -  A]_1B  (V-13) 


[I  +  L(s) ]  =  {K(s)[sl  -  (A  ♦  A  A) ]_1B  |  }K(s)tsI  -  A]_1B  [_1  (V-14) 
Therefore, 

7  [I  +  L(s)]  =  ff  |  K(s)[sl  -  (A  ♦AA)r1Bf|K(s)[sI  -  A]_1B }_1 

(V-16) 

In  other  words,  in  comparing  two  different  controllers,  the  difference 
in  minimum  singular  values  could  be  easily  overshadowed  by  the  effect 
of  the  differing  control  laws  on  the  magnitude  and,  perhaps  more 
importantly,  the  direction  of  the  perturbation.  This  may  explain  why  a 
fairly  radical  change  in  the  basis  for  the  controller  design,  such  as  a 
different  regulator  command  model,  could  make  predictions  of  robustness 


based  on  relative  sizes  of  singular  values  less  meaningful. 

In  general,  the  regulator  designs  which  exhibited  relative 
immunity  to  the  effects  of  higher  order  actuator  dynamics  were  those 
most  vulnerable  to  the  low  frequency  perturbations.  The  clearest 
example  of  this  was  within  the  IMF3  group  of  controllers.  Apparently, 
a  trade-off  decision  is  required  as  to  which  type  of  uncertainty  should 
be  most  heavily  guarded  against.  In  the  case  of  the  AFTI  F-16,  the 
"uncertainties"  of  nonlinearities  and  higher-order  actuator  dynamics 
are,  in  fact,  a  reality;  the  controller  must  work  despite  them.  The 
implicit  model-following  designs,  which  fulfilled  this  requirement, 
were  also  robust  for  a  reasonable  and  realistic  level  of  modelling 
error. 

In  summary,  singular  value  analysis  was  of  only  limited  value  in 
predicting  the  robustness  and  sensitivity  of  the  designs  with  regard  to 
parameter  variations  and  higher-order  dynamics.  The  variablity  of  the 
singular  value  measure's  conservatism  caused  it  to  be  misleading  in 
some  cases.  Regulator  pole  analysis  and  actual  simulation  provided 
reliable  Information  and  a  significant  degree  of  physical  insight.  The 
ability  of  the  implicit  model-following  formulation  to  affect  the 
location  of  the  regulator  poles  in  a  systematic  manner  was  found  to  be 
very  helpful  in  avoiding  problems  associated  with  higher-order 
dynamics,  but  this  was  generally  at  the  expense  of  increased 
sensitivity  to  parameter  variations. 


5.7  Anti-Windup  Compensation 


It  has  been  shown  that  Implicit  model-following  can  be  used  to 
alleviate  the  windup  problems  that  occur  in  PI  regulators  when 
nonlinear,  or  rate-  and  position-limited,  actuators  are  encountered. 

The  regulators  in  the  IMF3  group  were  especially  effective  in  this 
regard;  all  were  capable  of  handling  at  least  a  2.5  degree  initial 
condition,  without  performance  degradation,  when  tested  against  the 
nonlinear  single-state  actuator  model.  The  hybrid  CGT/PI  using  the 
regulator  from  IMF3-2  and  the  CGT  from  IMF2-5  was  shown  to  provide  good 
pitch-pointing  of  up  to  3  degrees  with  the  same  truth  model. 

When  the  effects  of  higher-order  actuator  dynamics  were  subse¬ 
quently  considered  in  addition  to  the  rate  and  position  limits,  the 
capabilities  of  these  designs  were  decreased  somewhat,  as  expected. 
However,  in  additional  teats  it  was  found  that  IMF3-2  and  IMF3-3  were 
still  stable  and  performed  without  degradation  with  initial  conditions 
of  1  and  2  degrees,  respectively,  using  a  full,  nonlinear  four-state 
actuator  model.  A  hybrid  CGT/PI  was  also  found  which  was  capable  of 
good  pitch-pointing  control  of  up  to  3  degrees  with  the  full,  nonlinear 
four-state  actuator  truth  model,  as  shown  in  Figure  V-45.  This  hybrid 
used  the  regulator  of  IMF3-3  and  a  CGT  based  on  a  regulator  design 
which,  while  of  the  IMF2  class,  and  similar  in  its  definition  and 
performance  characteristics  to  IMF2-4,  was  not  among  those  chosen  to  be 
discussed  in  this  thesis.  The  CGT  gains  for  the  hybrid  were 


and 
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While  the  use  of  a  controller  that  is  designed  specifically  to 
remain  within  the  linear  operational  range  of  the  actuators  is  a 
worthwhile  goal,  it  may  not  always  be  possible  to  implement.  Even  if 
such  a  design  were  possible,  it  would  be  wise  to  implement  some  form  of 
a  safeguard  that  would  enhance  the  stability  of  the  controller  in  the 
event  that  actual  conditions  exceeded  the  linear  range  for  which  the 
controller  was  designed.  Since  some  form  of  additional  anti-windup 
compensation  should  thus  inevitably  be  used  with  any  practical 
controller  implementation  of  the  type  addressed  in  this  study,  it 
seemed  imperative  that  its  effect  on  CGT/PI  designs  be  considered. 

The  form  of  anti-windup  compensation  Investigated  in  this  study 
involved  a  simple  modification  to  the  control  law  [30],  which  was 
Implemented  as  an  additional  user  option  in  ODEACT.  At  each  sample 
period,  when  the  new  control  inputs  are  calculated,  a  check  is  made  to 
ensure  that  those  control  inputs  are  not  of  a  magnitude  that  would 
command  the  rate  or  position  limits  of  the  actuators  to  be  exceeded. 

If  the  calculated  control  levels  are  excessive,  they  are  reduced  to  the 
maximum  allowable  level.  With  that  restriction  satisfied,  windup  does 
not  occur,  since  the  actuators  do  not  saturate.  Actually,  several 
variations  in  the  method  of  checking  and  limiting  the  controls  were 
tried;  the  most  successful  implementation  is  discussed  here. 

Consider  only  the  horizontal  tail  actuator,  which  was  position 
limited  to  t  25  degrees,  and  rate  limited  to  ±60  degrees  per  second. 


!  l"  .  '  .  •  .  f 
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and 


u(t^)  >  -3.6  ♦  x(t^),  for  x(t^)  <  0  (V-20b) 

An  Identical  development  was  used  to  calculate  the  maximum  controls  for 
the  trailing  edge  flap,  except  that  the  appropriate  limits  for  that 
actuator  were  used. 

With  this  simple  modification  to  the  control  law,  it  was  found 
that  the  IMF3-2  and  IMF3-3  regulators  could  withstand  at  least  an 
additional  1  degree  of  initial  conditions  against  the  full,  nonlinear 
four-state  actuator  model,  without  instability  being  induced.  The  IMF2 
regulators  showed  a  much  greater  improvement  with  anti-windup  compen¬ 
sation  than  did  the  IMF3  regulators.  The  response  of  IMF2-4  to  an 
initial  condition  of  10  degrees  using  the  full  nonlinear  four-state 
actuator  model  is  shown  in  Figure  V-46;  the  quality  of  this  response 
was  excellent. 

With  the  same  actuator  model,  the  IMF2-4  CGT/PI  response  to  a  step 
input  of  3  degrees  is  shown  in  Figure  V-47;  while  the  performance  is 
acceptable,  it  should  be  compared  to  that  of  the  hybrid  CGT/PI* s  under 
the  same  conditions.  The  response  of  the  hybrid  controller  whose 
response  without  compensation  was  shown  in  Figure  V-45  is  shown  with 
anti-windup  compensation  in  Figure  V-48.  Since  the  uncompensated 
response  was  quite  good,  the  improvement  due  to  compensation  was 
minimal,  primarily  seen  in  the  smaller  extent  of  the  actuator  over¬ 
shoots  and  the  smaller  maximum  flight  path  angle  deviation.  However, 
compared  to  the  IMF2-4  response  of  Figure  V-47,  this  hybrid  design 
produced  better  model-following  in  the  pitch  angle,  plus  a  smaller  and 
more  rapidly  corrected  deviation  in  the  flight  path  angle.  The  other 
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hybrid  CGT/PI,  constructed  from  the  elements  of  IMF3-2  and  IMF2-5,  was 
improved  considerably  through  the  use  of  anti-windup  compensation. 
Without  such  compensation,  it  was  unstable  with  a  3  degree  step  input 
when  evaluated  against  the  nonlinear  four-state  actuator  model;  with 
compensation,  its  response  is  shown  in  Figure  V-49.  By  all  standards 
of  comparison  with  Figure  V-48,  the  hybrid  based  on  IMF3-2  was  nearly 
equal  to  or  better  than  the  one  based  on  IMF3-3,  which  had  performed 
better  in  the  uncompensated  mode. 

The  baseline  regulator  also  showed  significant  improvement  when 
anti-windup  compensation  was  used;  this  was  to  be  expected,  since  it 
had  the  most  to  gain  from  such  compensation.  However,  as  with  some  of 
the  implicit  designs,  the  controller  was  still  not  useful,  since  it  was 
still  degraded  by  the  effects  of  the  higher-order  actuator  dynamics. 

In  summary,  the  employment  of  anti-windup  compensation  ha3  been 
shown  to  enhance  the  capabilities  of  the  controller  designs.  When  used 
with  implicit  model-following  regulators  that  were  immune  to  the 
effects  of  higher-order  actuator  dynamics,  both  stability  and  perfor¬ 
mance  improvements  were  realized,  resulting  in  potentially  very  useful 
designs . 


Definition  of  Designs  Using  Standard  PI  Regulator  Formulation 
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*  Truth  model  is  otherwise  identical  to  linear  design  model 
t  Oscillatory, 
t  Non-oscillatory . 
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Truth  model  is  otherwise  identical  to  linear  design  model 
t  oscillatory, 
t  non-oscillatory . 


*  Singular  values  at  this  frequency  equals  or  exceeds  the  value 
for  the  baseline  (SR-B)  design. 

**  Refer  to  Appendix  E. 


Definition  of  Designs  Using  Implicit  Model-Following 
with  a  Three-State  Regulator  Command  Model 
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Summary  of  Minimum  Singular  Values  (Inverse  Return  Difference)  and  Regulator 
Pole  Locations  for  Implicit  Designs  with  a  Three-State  Regulator  Command  Model 
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Singular  value  at  this  frequency  equals  or  exceeds  the  value 
for  the  baseline  (SR-B)  design. 

Refer  to  Appendix  E. 
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Design  SR-B,  Linear  Design  Model  Actuators 
CGT  Response  to  Step  Input  =  1  Degree 


88+3889* 

88+388T- 

I8+3MI*- 

18+3811 

*-  18+3893*-  !8+38t£ 

18+3111  * 

18+38£J* 

88+3886* 

88+388S 

M+3MI*  88+388S 

88+38£J* 

18+388! * 

I8-3MZ* 

18-3889 

18-3MI*  18-3881 

88+3HI* 

18-3H1* 

18-3889* 

18-388! 

18-3881*-  I8-388S 

♦ 

9 

♦ 

♦ 

♦ 

! 

♦ 

£1 

♦ 

*•  * 

•a*  • 

iti  * 

■  •  •  i  « 

•  •  • 

:j: 

•a» 
•  T  • 

£i:  : 

:+ 

♦ 

9 

♦ 

♦ 

♦ 

I 

♦ 

£! 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

l 

+ 

£! 

♦ 

♦ 

* 

♦ 

♦ 

♦ 

I 

♦ 

£3 

♦ 

♦ 

9 

♦ 

+ 

♦ 

l 

♦ 

£3 

+ 

♦ 

9 

♦ 

♦ 

♦ 

l 

+ 

£3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

! 

+ 

£Z 

* 

♦ 

» 

♦ 

♦ 

♦ 

1 

♦ 

£3 

♦ 

♦ 

9 

♦ 

+ 

♦ 

! 

♦ 

£3 

+ 

♦ 

9 

+ 

♦ 

+ 

I 

+ 

£  3 

♦ 

A*  • 
▼  •  • 

:9: 

•a*  • 

ifl  • 

•  •  !•» 

•  •  |T| 

:i: 

•a* 

•  T  • 

£  3  : 

:♦ 

♦ 

9 

+ 

♦ 

+ 

i 

♦ 

£  Z 

♦ 

+ 

9 

♦ 

♦ 

♦ 

i 

♦ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

i 

♦ 

£  3 

♦ 

•f 

9 

♦ 

+ 

+ 

i 

+ 

£  Z 

♦ 

+ 

9 

+ 

♦ 

♦ 

! 

+ 

£  3 

* 

♦ 

9 

♦ 

♦ 

♦ 

I 

♦ 

£  3 

♦ 

♦ 

9 

+ 

+ 

♦ 

! 

♦ 

£  3 

* 

♦ 

9 

♦ 

♦ 

♦ 

1 

+ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

! 

+ 

£  3 

♦ 

*•  • 

:9: 

•a*  • 

•  ▼ «  t 

•  t  •  .  • 

•  1  «T| 

:j: 

:+: 

£  3  : 

:+ 

+ 

9 

♦ 

+ 

♦ 

I 

+ 

£  3 

♦ 

+ 

9 

♦ 

♦ 

♦ 

I 

♦ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

i 

+ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

l 

♦ 

£  Z 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

l 

♦ 

£  3 

♦ 

+ 

9 

♦ 

♦ 

♦ 

l 

♦ 

£  Z 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

I 

♦ 

£  Z 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

I 

♦ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

l 

♦ 

£  3 

♦ 

*•  • 

:9< 

•a»  • 

•  1  l>l 

•  I  IT! 

I 

:+: 

£  :  3 

:+ 

♦ 

9 

♦ 

♦ 

♦ 

! 

♦ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

! 

♦ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

I 

♦ 

£  3 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

1 

♦ 

£  Z 

♦ 

♦ 

9 

♦ 

♦ 

♦ 

l 

♦ 

£ 

3  ♦ 

♦ 

9 

♦ 

* 

♦ 

I 

♦ 

£ 

3  ♦ 

♦ 

9 

♦ 

♦ 

♦ 

1 

♦ 

£ 

3  ♦ 

♦ 

9 

♦ 

♦ 

+ 

l 

♦  £ 

3  ♦ 

♦ 

9 

♦ 

+ 

♦ 

! 

♦£ 

3  ♦ 

A*  • 
r  •  • 

:9: 

'a1  • 

•  Tt  • 

•  •  lil 

•  •  iTi 

:i 

:£: 

•  •  • 

3+ 

♦ 

9 

♦ 

♦ 

+ 

(  £ 

3+ 

♦ 

9  ♦ 

+ 

♦ 

♦  £ 

3+ 

♦ 

♦9 

♦ 

+ 

♦ 

£  3  ♦ 

♦ 

♦ 

9  ♦ 

♦ 

♦ 

3 

l£+ 

♦ 

♦ 

♦ 

9  ♦ 

1+ 

! 

£+ 

♦ 

+ 

♦ 

♦I 

{ 

9  £ 

♦ 

♦ 

♦ 

l  +3£ 

♦ 

♦ 

9 

♦ 

I  c 

♦  I 

+ 

♦ 

9 

+ 

+ 

nrr\ 

fff?ai 
H9£'l 
HIS 'I 
8889*1 
8899*1 

«mai 
M?£*I 
MIS*  I 
M8I'I 

mi*  i 
8M3*! 
8891*1 
Mil*  l 
8888*1 
MM 'I 
MM*  I 
M96* 
MI6* 
8888* 
M9B* 
M#8* 
8891* 
Mil* 
M89* 
MM* 
•M9* 
M9S* 
MIS* 
M89* 
MM* 


«  CV 


•*»  r 


Initial  Condition 


H+3f#r  ll+3f£l \I*W-  t|43#SS'-  II+3I&9'-  i  3TWS 
If«3fl£*  !f+3MZ‘  Ift3ff6*  M+3MZ-  !f»3KI*-  l»+3#*Z’-  £  3H/3S 
!f-3#tr  Z#-3Ht*-  H-3KZ*-  ll-Jfft  -  If-3#8S*-  Ih3»r-  l  3TWS 


M 

II+3HI'  M+3#f8‘  H+3H9"  H«3ffi 

*•  i  rwas 

,i 

!  Z 

♦  £ 

* 

4 

4 

» 

ffff'Z 

i:  :  :  z 

(•Ml  • 
(Till  •  • 

:♦:::: 

•a  • 
it  1 

:  :  :t 

iff 6* i 

£ 

I  z 

♦  £ 

♦ 

4 

4 

» 

MZ&M 

I  z 

♦  £ 

♦ 

♦ 

4 

N68'l 

V 

l  z 

♦  £ 

♦ 

4 

4 

Ht8M 

J  l 

♦  £ 

* 

4 

4 

IMS'! 

s  z 

♦  £ 

+ 

4 

4 

» 

Hfi'l 

l  z 

♦  £ 

♦ 

4 

4 

t 

iszri 

I  z 

♦  £ 

♦ 

4 

4 

> 

##89* I 

09 

l  z 

♦  £ 

♦ 

4 

4 

HM’J 

t. 

I  l 

+  £ 

♦ 

4 

4 

itifl 

O 

+» 

i:  :  z  : 

(.Ml  I  • 
■▼•4*  •  ■ 

•  ▼  • 

•  1  1  L 

•  •  If 

HtS’l 

at 

_ _ 

I  z 

+  £ 

♦ 

4 

4 

t 

ffZS'I 

3 

4J 

* 

\  z 

♦  £ 

♦ 

4 

4 

H8VI 

o 

I  z 

♦  £ 

♦ 

4 

4 

» 

MM*  t 

*c 

.*■ 

I  z 

♦  £ 

4 

4 

♦ 

» 

Mft'l 

V 

1  z 

♦  £ 

4 

4 

4 

t 

Mt£'l 

4^ 

I  z 

♦  £ 

♦ 

4 

4 

i 

MZ£‘I 

l  z 

♦  £ 

4 

4 

4 

MBZ‘1 

CO 

l  z 

♦  £ 

4 

4 

4 

f 

MtZ'I 

a> 

1  z 

♦  £ 

4 

4 

4 

» 

mz-i 

rH 

U) 

n  i:  z  :  : 

•“#*#  •  • 

•  t  • 

:  :  :t 

MfP! 

c 

J- 

I  z 

♦  £ 

4 

4 

4 

Mzrr 

■H  Q> 

co  a) 

0 

1  z 

♦  £ 

4 

4 

4 

» 

M8«! 

I  z 

♦  £ 

4 

4 

4 

i 

MM*  I 

U  bo 
at  © 
v  a 

C> 

I  z 

♦  £ 

4 

4 

4 

i 

MM’I 

s* 

I  z 

♦  £ 

4 

4 

4 

i 

M94‘ 

c 

•H  ^ 

I  z 

♦  £ 

4 

4 

4 

i 

MZ6‘ 

i! 

(  z 

♦  £ 

4 

4 

4 

fr 

M88* 

C  M 
o 

♦IZ 

♦  £ 

4 

4 

4 

♦ 

MW 

z  *> 

♦IZ 

+  £ 

4 

4 

4 

» 

M08* 

3 

+i  z  :  : 

•  «•<*•  ■  • 
•  • 

:  :  : 

•  tl 

:  :  :» 

fffi’ 

BJ  C 

♦I  z 

♦  £ 

4 

♦ 

4 

i* 

Mzr 

•  M 

as 

♦I  z 

♦  £ 

4 

4 

4 

>4 

M89‘ 

co  a, 

♦I  z 

♦  £ 

4 

4 

4 

»4 

mr 

0) 

+!  Z 

♦  £ 

4 

4 

4 

f  4 

Ml?* 

60  CO 

♦  I  Z 

♦  £ 

4 

4 

4 

f  4 

MfS* 

•H 

0}  H 

♦  I  Z 

♦  £ 

4 

4 

4 

t  4 

MZ£' 

♦  t  Z 

♦  £ 

4 

4 

4 

f  4 

M8P 

♦  l  z 

♦  £ 

4 

4 

4 

*  4 

MM’ 

♦  IZ 

♦  £ 

4 

4 

4 

f  4 

MM* 

• 

♦:  :  iz: 

:♦::£: 

u:  :  :  : 

J4: 

t:  :  :4 

M?£* 

i 

i" 

♦  I 

l  ♦  £ 

4 

4 

4  ♦ 

4 

MZ£‘ 

> 

V 

♦  i :  ♦  z 

4 

4 

»4 

4 

M8Z' 

♦  £ 

!  ♦ 

♦  z 

4  f 

4 

4 

M»Z* 

t* 

3 

♦  £ 

♦  l 

4 

4  »  Z 

4 

4 

MfZ* 

to 

Cl 

t 

£♦ 

♦  l 

»♦ 

4 

Z  4 

M9I* 

•H 

Du 

♦ 

♦ 

♦  a 

4  I 

4 

z 

MZP 

*, 

♦ 

♦ 

4» 

4 

Z4 

(£  4 

MSI' 

•• 

♦ 

♦  t 

Z4 

4 

4 

£ 

MM’ 

♦> 

:  * 

4 

£4 

4 

l 

Mff'f 

M 

►  . 

> 

* 

i 

V-48 

m 

w\ 

■*, 

3 

mSSm 

kjV.'kl***/**. 

IM3M9'  IM3M*'-  ZM3MI  *-  Zf43HZ'-  zi+3M£'-  zv»ama- 
Zf *HZZ‘  lt*3hV  IM3M9*  !»+3#fZ*-  Zf+3Ml'-  ZM3#8I'- 
If+3fZr  M+3M6’  H+3M9'  H-38ZI’-  M+3M£- 

lf+»U'  M+3MZ'  #f»3##£'  H*3fl!‘-  MOMS'-  HOM6‘- 


*  31MS 
£  31WS 
Z  3TWS 
l  31WS 


♦ 

♦ 

4 

l£ 

4  Z 

4 

Nfl'Z 

♦: 

:  :  fr 

■  .  •  i 

•  T  ■  a 

•  • 

•  • 

•*» 
IT  ■ 

a  a 
a  a 

:  :i£  :  : 

:  :4Z  : 

a  a 
a  a 

:4 

M96'l 

♦ 

» 

4 

4 

t£ 

z 

4 

MZi'I 

♦ 

i 

♦ 

4 

£  ♦ 

z 

4 

W88‘l 

♦ 

i 

♦ 

4 

£ 

4 

4Z 

4 

M98'I 

♦ 

9 

♦ 

4 

( 

£  4 

4  Z 

4 

M#8'J 

♦ 

» 

4 

4 

£♦ 

4  Z 

4 

M9£'I 

♦ 

» 

♦ 

4 

4l£ 

+z 

4 

MZZ'I 

♦ 

> 

♦ 

4 

t£ 

z 

4 

mri 

+ 

♦ 

4 

£  4 

z 

4 

M99'l 

♦ 

» 

4 

4 

£1 

4 

♦z 

4 

MW'! 

♦: 

: 

IT*  a 

•  • 

•  • 

«*» 

:£t 

:  :  : 

:  :4  :z: 

a  a 
a  a 

:4 

M9S*I 

♦ 

9 

♦ 

4 

£  4 

4  Z 

4 

MZS'l 

♦ 

9 

♦ 

4 

4  £ 

4  Z 

4 

M89'l 

♦ 

9 

♦ 

4 

4  !£ 

4  Z 

4 

M99'i 

♦ 

9 

♦ 

4 

I£4 

Z 

4 

Hit'! 

♦ 

V 

♦ 

4 

£ 

4 

z 

4 

M9£‘I 

♦ 

lr 

♦ 

4  £1 

4 

4  Z 

4 

MZ£'( 

♦ 

9 

♦ 

4 

£1  ♦ 

4  i 

r 

« 

4 

MBZ'J 

♦ 

9 

♦ 

4 

4  £ 

♦  i 

F 

* 

4 

MW  I 

+ 

1 

r  ♦ 

4 

4  l£ 

4  Z 

4 

MIZ'I 

♦: 

:  :  9 

: 

•  • 

•  • 

it  • 

•  a 
a  a 

:  :i£  :  : 

a  ay  a  a 
a  «(,  a  « 

a  a 
a  a 

:4 

M9ri 

♦ 

9 

♦ 

4 

£ 

4 

Z 

4 

MZ!'! 

♦ 

9 

* 

£  I 

4 

4  Z 

4 

M8f‘I 

♦ 

9 

* 

4 

£1 

4 

4 

Z 

4 

MM'! 

♦ 

9 

* 

4 

4  £ 

4 

Z 

4 

MU'! 

♦ 

1 

t  * 

4 

4 

I£  4  l 

4 

M96’ 

♦ 

9  * 

4 

4  t£ 

Z 

4 

MZ  6‘ 

♦ 

9 

* 

4 

£1  4 

Z 

4 

M88‘ 

+ 

9 

+ 

£  I 

4 

4  Z 

4 

MM' 

♦ 

9 

♦ 

£ 

I 

4 

4 

z 

4 

MM* 

♦: 

:  :  9 

: 

•  a 

•  a 

.*4: 

a  a 
a  a 

:  :£i  :  : 

a  a  »  a  a 
a  aT  a  a 

:  z 

14 

M9£' 

♦ 

I 

i  ♦ 

4 

4 

!£♦ 

z 

4 

MZZ' 

♦ 

1 

r  + 

4 

4 

!£  *Z 

4 

M89* 

♦ 

9 

♦ 

4 

£1  4 

Z* 

4 

M99’ 

♦ 

9 

♦ 

£ 

l 

4 

4Z 

4 

M«9‘ 

♦ 

9 

♦ 

£ 

I 

4 

4 

z 

4 

M9S' 

♦ 

9 

♦ 

4 

£  I 

4 

Zt 

MZS* 

♦ 

94 

4 

4 

£1 

z 

4 

M89' 

♦ 

9* 

4 

4 

4  Z£ 

4 

MM' 

♦ 

9 

♦ 

4 

4  £1 

Z+ 

4 

MM' 

♦: 

: 9 : 

:+:  : 

:£.’ 

:j: 

a  a 
a  a 

a  ay  a  a 
•  Ifai  a 

a  a 
a  a 

:4 

M9£‘ 

♦ 

9 

£♦ 

I 

4 

4 

4 

3 

4 

MZ£* 

♦ 

9 

♦ 

♦£ 

l  4 

4 

z* 

M8Z* 

♦ 

9 

♦ 

4 

4 

4£  I 

z* 

M9Z' 

♦ 

* 

♦ 

4 

4 

4 

Z 

£ 

M#Z’ 

♦ 

♦ 

9 

4 

4 

£  4  I 

4 

M9I* 

♦ 

♦  £ 

4 

l 

z+ 

9 

4 

MZ!' 

♦£ 

l  ♦ 

Z 

4 

4 

4 

9 

M8f‘ 

♦ 

I  i 

:  ♦ 

s 

;  ♦ 

9 

♦ 

4 

4 

MM' 

♦ 

I  9Z 

♦ 

4 

£  4 

4 

4 

MM'f 

v.>*iy2y 


.■V.'V/vW  AA •  • 


TO 


Figure  V-6.  Design  SR-B,  Linear  Four-State  Actuators 
Initial  Condition  =  1  Degree 
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Figure  V-7.  Design  SR-B,  Linear  Single-State  Actuators 
Flight  Condition  =  .6  Mach/20,000  feet, 
Initial  Condition  =  1  Degree 
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Figure  V-8.  Design  SR-B,  Linear  Single-State  Actuators 
Flight  Condition  =  .6  Mach/30,000  feet. 
Initial  Condition  =  1  Degree 


Design  SR-B,  Singular  Values  of  Inverse  Return  Difference 
Function  Over  Frequency  Range  of  U) =  .0001  to  .01 
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Figure  V-12.  Design  SR-2,  Nonlinear  Single-State  Actuators 
Initial  Condition  =  0.1  Degree 


Initial  Condition  =0.5  Deg 
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Figure  V— 1 4 .  Design  SR-2,  Nonlinear  Single-State  Actuators 
CGT  Step  Input  =  3  Degrees 
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Figure  V-15.  Design  IMF2-1,  Nonlinear  Single-State  Actuators 
Initial  Condition  =0.1  Degree 
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Design  IMF2-1,  Nonlinear  Single-State  Actuators 
Initial  Condition  =  0.5  Degree 


Figure  V-17.  Design  IMF2-1,  Nonlinear  Single-State  Actuators 
CGT  Step  Input  =  3  Degrees 
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Figure  V-18.  Design  IMF 2-2,  Nonlinear  Single-State  Actuators 
Initial  Condition  =0.1  Degree 
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Figure  V-19*  Design  IMF2-2,  Nonlinear  Single-State  Actuators 
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Figure  V-22.  Design  IMF2-1!,  Nonlinear  Single-State  Actuators 
Initial  Condition  =  1  Degree 
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Figure  V-25.  Design  IMF2-5,  Nonlinear  Single-State  Actuators 
CGT  Step  Input  =  1  Degree 
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Figure  V-27.  Design  IMF3-2,  Nonlinear  Single-State  Actuators 
Initial  Condition  =  1  Degree 
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Figure  V-28.  Design  IHF3-3*  Nonlinear  Single-State  Actuators 
Initial  Condition  =  1  Degree 


Design  IMF3-4,  Nonlinear  Single-State  Actuators 
Initial  Condition  =  1  Degree 


Figure  V-30.  Design  IMF3-5,  Nonlinear  Single-State  Actuators 
Initial  Condition  =  1  Degree 
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Figure  V-32.  Hybrid  Design  (PI  Regulator  IMF3-2,  CGT  from  IMF2-2), 

Nonlinear  Single-State  Actuators,  CGT  Step  Input  =  1  Degree 
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Initial  Condition 


Design  IMF2-1!,  Linear  Four-State  Actuators 
Initial  Condition  =  1  Degree 


Design  IMF3-1,  Linear  Four-State  Actuators 
Initial  Condition  =  1  Degree 
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Design  IMF2-M,  Linear  Single-State  Actuators 
Flight  Condition  =  .6  Mach/20,000  feet. 
Initial  Condition  =  1  Degree 
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Figure  V-M 3*  Design  IMF3-1,  Linear  Single-State  Actuators 
Flight  Condition  =  .6  Mach/20,000  feet. 
Initial  Condition  =  1  Degree 
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Figure  V-45.  Hybrid  Design  (PI  Regulator  IMF3-3,  Undesignated  CGT), 

Nonlinear  Four-State  Actuators,  CGT  Step  Input  =  3  Degrees 
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Figure  V-46.  Design  IMF2-4,  Nonlinear  Four-State  Actuators, 

Anti-Windup  Compensated,  Initial  Condition  =  10  Degrees 


Figure  V-M7.  Design  IMF2-1!,  Nonlinear  Four-State  Actuators, 

Anti-Windup  Compensated,  CGT  Step  Input  =  3  Degrees 
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Figure  V-49.  Hybrid  Design  (PI  Regulator  IMF3-2,  CGT  from  IMF2-5), 

Nonlinear  Four-State  Actuators,  Anti-Windup  Compensated 
CGT  Step  Input  =  3  Degrees 


VI.  Conclusions  and  Recommendations 

6.1  Implicit  Model-Following 

This  study  has  demonstrated  that  the  incorporation  of  an  implicit 
model  into  the  performance  index  used  to  define  a  linear-quadratic  PI 
regulator  can  provide  greater  control  over  many  aspects  of  the 
resulting  controller  design  than  that  achievable  using  a  "standard"  PI 
regulator.  In  particular,  implicit  model-following  was  shown  to  be 
useful  in  controlling  the  speed  of  the  initial  response  of  the 
regulator,  as  characterized  by  rise  time.  This  produced  a  controller 
which  could  perform  acceptably,  despite  the  constraints  of  harsh 
nonlinearities  inherent  in  the  controlled  system,  because  it  was 
designed  so  that  it  could  perform  its  function  without  exceeding  the 
range  of  linear  operation.  Compared  to  design  methods  using  conven¬ 
tional  PI  regulator  formulations,  implicit  model-following  was  shown  to 
provide  an  increased  ability  to  control  the  locations  of  the 
closed-loop  system's  poles,  in  a  systematic  and  easily  predictable 
fashion,  by  means  of  iterative  changes  to  the  quadratic  weightings  used 
in  the  design.  This  ability  was  found  to  be  useful  in  designing  to 
avoid  the  effects  of  higher-order  dynamics  inherent  in  the  controlled 
system,  but  ignored  in  the  design  model. 

The  use  of  an  "all-implicit"  PI  regulator,  based  only  on  the 
quadratic  cost  of  (A— 43 ) »  was  found  to  be  feasible.  Good  transient 
response  and  steady-state  regulation  were  both  achievable  without  the 
use  of  "explicit"  weights  applied  directly  to  the  output  deviations. 

For  the  designs  presented  in  this  thesis,  it  appeared  that 
achieving  the  capability  to  operate  well  despite  one  type  of  pertur- 


bation  generally  occurred  at  the  expense  of  robustness  against  another 
type.  The  designs  conducted  with  the  standard  regulator  formulation 
exhibited  relatively  good  performance  with  regard  to  parameter 
variations,  but  were  degraded  by  higher-order  dynamics  and  actuator 
nonlinearities.  Implicit  designs  developed  to  improve  robustness  with 
respect  to  higher-order  dynamics  and  nonlinearities  were  generally 
somewhat  less  robust  with  regard  to  parameter  variations.  This  high¬ 
lighted  the  need  for  some  insight  on  the  part  of  the  designer  as  to  the 
types  of  uncertainty  prevalent  in  the  design  model. 

An  ability  to  provide  a  general  increase  in  robustness  by  forcing 
the  closed-loop  system  to  have  maximally  orthogonal  eigenvectors  was 
not  shown.  The  robustness  benefits  of  3uch  an  eigenstructure  have  been 
documented  [19].  However,  the  closed-loop  PI  regulator  formulation  is 
fairly  complex;  the  number  and  dimension  of  its  eigenvectors  are  large 
in  comparison  to  the  number  of  controls  available  to  affect  their  form. 
Admittedly,  the  eigenvectors  of  the  designs  were  not  calculated  in  this 
study,  and  the  design  iterations  were  focused  on  achieving  specific 
objectives  other  than  an  orthogonal  eigenstructure.  It  is  quite 
possible  that  implicit  model-following  might  be  shown  to  have  potential 
general  robustness  benefits,  at  least  for  some  problems,  if  an  effort 
were  made  to  design  specifically  toward  achieving  maximally  orthogonal 
eigenvectors.  Such  a  design  approach  could  inevitably  be  expected  to 
require  some  sort  of  tradeoff  with  other  characteristics  of  the 
resulting  design,  such  as  performance  capabilities. 


6.2  Robustness  Analysis 

In  this  study,  "unstructured"  singular  value  analysis  was  found  to 
be  of  limited  value  in  predicting  how  well  a  system  would  perform  with 
respect  to  off-nominal  conditions.  There  are  several  factors  which 
contributed  to  this  observation. 

The  first  factor  is  the  variable  conservatism  of  robustness 
estimates  that  are  based  on  this  type  of  singular  value  analysis.  Even 
if  the  norm  of  a  particular  perturbation  were  known  exactly,  comparison 
to  the  minimum  singular  value  of  the  closed-loop  system's  inverse 
return  difference  function  could  provide,  at  best,  only  positive  proof 
that  the  perturbation  could  not  be  destabilizing.  If  such  an  analysis 
were  to  show  the  norm  of  the  perturbation  to  be  sufficient  to  cause 
instability,  there  would  remain  three  possibilities: 

—  That  instability  would  result. 

—  That  performance  would  be  degraded,  but  the  system  would  be 
stable. 

—  That  little  or  no  degradation  to  performance  or  stability 
would  result. 

Some  other  method  of  analysis,  such  as  simulation,  would  be  required  to 
determine  the  ac'tual  effect  of  such  a  perturbation. 

The  second,  and  related,  factor  is  that  this  type  of  analysis 
presupposes  that  the  designer  can  formulate  an  estimate  of  the  norm  of 
the  uncertainties  that  should  be  guarded  against.  As  pointed  out  in 
Section  5.6,  the  norm  of  the  multiplicative  perturbation  that  results 
from  a  change  to  the  nominal  dynamics  description  is,  in  fact,  a  fairly 
complex  function  of  both  that  change  and  the  control  law.  Considera¬ 
tion  of  the  effects  of  nonlinearities  presents  a  particularly  difficult 


problem.  This  adds  to  the  uncertainty  as  to  which,  if  any,  possibly 
destabilizing  perturbations  would  actually  produce  instability.  Design 
iterations  aimed  simply  at  increasing  minimum  singular  values  could,  in 
fact,  result  in  trading  off  performance  to  guard  against  a  perturbation 
which  could  not  occur  physically. 

The  final  factor  is  the  fact  that,  in  many  cases,  simulation  can 
readily  provide  the  type  of  robustness  information  that  the  designer 
needs,  in  a  form  which  is  unambiguous  and  easy  to  interpret.  While  it 
is  impossible  to  simulate  all  of  the  possible  perturbations,  judicious 
selection  of  example  cases  which  encompass  the  spectrum  of  known  areas 
of  uncertainty  is  possible.  Nonlinearities,  shown  in  this  study  to  be 
of  significant  potential  impact,  are  easy  to  simulate,  and  the  type  of 
simulation  used  for  the  deterministic  controllers  in  this  study  can 
easily  be  extended  to  the  Monte  Carlo  analysis  of  stochastic 
controllers  [29,36].  Sensitivity  analysis  can  be  conducted  in  a 
straightforward  way,  through  simulation,  to  gain  insight  into  the 
physical  factors  exercising  the  greatest  influence  over  performance  and 
stability. 

The  results  of  the  singular  value  analysis  conducted  in  this  study 
were  not,  in  general,  inconsistent  with  the  simulation  results;  they 
simply  added  little  insight.  In  some  cases,  the  singular  value 
analysis  results  were  very  misleading,  such  as  the  relatively 
optimistic  high  frequency  robustness  predictions  that  could  have  been 
made  for  designs  IMF3-4  and  IMF3-5. 


6.3  Recommendations  for  Further  Stud; 


A  great  deal  of  the  design  effort  described  in  this  thesis 
centered  on  combatting  an  effect  called  "windup"  which  occurs  in  PI 
regulators,  due  to  control  actuator  saturation.  A  concurrent  thesis 
effort  by  Lt  James  McMillian  [32]  has  produced  another  modification  to 
the  CGT/PI/KF  design  software  that  implements  a  generic  formulation  of 
the  PI  regulator  [30].  In  this  implementation,  the  proportional  and 
integral  channels  of  the  regulator  output  feedback  are  distinct,  and 
need  not  be  equal.  The  susceptibility  of  a  PI  regulator  to  the  windup 
phenomenon  should  be  a  function  of  the  magnitude  of  the  integral 
channel  feedback  relative  to  that  of  the  proportional  channel. 
Anti-windup  compensation  through  the  use  of  the  capabilities  provided 
by  Lt  McMillian* s  program,  in  conjunction  with  implicit 
model-following,  should  be  investigated.  The  effects  of  such 
compensation  on  the  general  robustness  of  the  controller  should  also  be 
determined. 

As  discussed  in  Section  5.5,  use  of  a  diagonal  regulator  command 
model  dynamics  matrix  in  this  study  represented  only  one  of  many 
possible  command  model  structures.  Investigation  of  the  performance 
and  robustness  characteristics  of  implicit  regulator  designs  based  on 
different  structures,  i.e.,  with  various  types  and  numbers  of 
off-diagonal  command  model  dynamics  matrix  elements,  should  be 
conducted. 

For  the  designs  of  this  study,  the  use  of  unstructured  singular 
value  analysis  was  found  to  provide  little  predictive  insight  into 
design  robustness.  As  mentioned  in  Section  3*2,  a  great  deal  of 
current  study  is  underway  involving  the  use  of  "structured"  singular 


value  analysis  [12,15,18,27]*  To  employ  such  sophisticated  methods, 
the  designer  must  have  insight  into  the  structure  of  the  types  of 
uncertainty  that  are  likely  to  be  present  in  the  control  system.  Such 
insight  was  not  in  the  repertoire  of  the  author  of  this  thesis.  A 
study  of  methods  of  analyzing  the  structure  of  modelling  error  and  the 
application  of  knowledge  of  that  structure  to  singular  value  analysis 
is  a  recommended  area  for  future  research. 

Another  concurrent  thesis  effort  by  Lt  Jean  Howey  [22]  has 
centered  on  the  recovery  of  robustness  lost  due  to  the  employment  of  a 
Kalman  filter  to  provide  state  estimates  for  a  PI  regulator.  The 
effectiveness  of  the  methods  developed  in  that  study  should  be 
determined  for  control  systems  in  which  implicit  model-following  is 
employed,  as  in  this  research.  A  logical  extension  of  such  a  study 
would  include  modelling  and  analyzing  the  complete  system  with  a  human 
operator  in  the  loop. 
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A.  LQG  Regulator  Synthesis 

A. 1  Introduction 

This  thesis  frequently  refers  to  inner-loop  controller  designs 
based  on  linear  system  models,  quadratic  costs  and  Gaussian  distur¬ 
bances  (the  LQG  assumptions).  The  PI  regulator  used  in  the  CGT/PI/KF 
controller  is  a  sampled-data  optimal  controller  based  on  these  LQG 
assumptions.  Chapter  II  briefly  outlines  the  overall  structure  of  the 
CGT/PI/KF  controller  as  well  as  the  concept  of  the  alteration  of 
closed-loop  system  characteristics  by  means  of  implicit 
model-following.  In  that  chapter,  it  is  assumed  that  the  reader  under 
stands  the  fundamental  synthesis  techniques  involved  in  LQG  designs, 
for  both  simple  regulators  and  PI  regulators. 

This  appendix  is  a  very  brief  review  of  the  development  of  those 
LQG  synthesis  techniques,  intended  to  introduce  concepts  and  notation 
used  elsewhere  in  the  thesis  and  in  the  design  software  that  was 
employed  in  this  study.  Emphasis  is  on  sampled-data  controllers  that 
are  based  on  models  representing  actual  discrete-time  systems,  or  on 
equivalent  discrete-time  models  for  continuous-time  systems.  For  a 
more  complete  and  general  development,  refer  to  [30];  the  specific 
formulation  upon  which  the  designs  of  this  study  are  based  is  included 
in  [16,3^]. 


Consider  a  linear,  time-invariant  system  which  can  be  described  by 


the  vector  state  equation 


(A-1 ) 


The  system  states  at  discrete  sample  times  are  represented  by  the 
vector  x(t^),  and  u(t^)  is  the  control  applied  at  time  t^,  and  held 
constant  until  time  t  If  the  model  represents  an  actual  discrete 

process,  then  w^(t^)  is  a  zero-mean,  discrete-time  white  Gaussian 
driving  noise  of  covariance  applied  to  the  states  through  the 
distribution  matrix  G^.  Often  the  model  is  an  equivalent  discrete-time 
description  of  an  underlying  continuous- time  process  [30];  in  such  a 
case,  the  equivalent  discrete-time  control  matrix  and  driving  noises 
can  be  developed  from  the  related  continuous-time  quantities  as 


f\+ 1 

=  J  t(t1+1,r)Bd 


(A-2a) 


(A-2b) 


iti+l 

<j>(t1,1.T)GQGV(t1,1.r)dr 


(A-2c) 


where  ^(t^+^,r)  is  the  state  transition  matrix  associated  with  A  in  the 


continuous-time  model 


x(t)  s  Ax(t)  ♦  Bu(t)  ♦  Gw(t) 


(A-3a) 


and  Q  is  the  strength  of  the  white  Gaussian  noise  a(t): 


Ejw(t)wT(t+r)f  =  £*(r) 


(A-3b) 


Note  that  if  A,  B,  G,  and  (J  are  constant  and  the  sample  period  is 
fixed,  then  the  matrices  in  (A-2)  need  only  be  evaluated  once  for  all 
sample  periods.  Also,  the  $  of  (A-1)  is  just  $(t^+^,t^)  of  (A-2)  and, 
again,  it  is  the  same  for  all  sample  periods* 

The  system  outputs  are  a  linear  combination  of  the  system  states 

£(^5  =  CxC^)  (A-4) 

Equation  (A-4)  may  be  generalized  to  include  direct  feedthrough  of  the 
control  inputs  to  the  system  outputs,  but  doing  so  will  change  neither 
the  most  general  form  of  the  quadratic  cost  function  nor  the  form  of 
the  controller.  Such  a  generalization  is  therefore  unnecessary  at  this 
point  in  the  development  of  a  simple  regulator  [30].  Feedback  control 
is  based  on  noise  corrupted  sampled-data  measurements  of  the  system 
states  in  the  form 

aCtj.)  =  Hx  ( )  +  v{t±)  (A-5) 

where  v(t^)  is  a  zero-mean,  discrete-time  white  Gaussian  measurement 
noise  of  covariance  _R,  which  is  independent  of  j^(t^). 

Under  the  LQG  assumptions,  the  optimal  controller  for  the  system 
just  described  consists  of  an  optimal  (LQ)  deterministic  controller 
cascaded  with  an  optimal  linear  Kalman  filter,  and  the  design  of  the 
controller  and  the  filter  can  be  conducted  separately;  this  is  an 
important  property  known  as  certainty  equivalence  [30].  Thus,  the 
controller  can  be  designed  based  on  a  simpler  deterministic  model 
consisting  of  (A-4)  and 


The  result  Is  a  linear-quadratic-state-feedback  (LQSF)  controller;  in 
the  final  implementation,  the  state  values  used  for  feedback  may  be 
replaced  by  Kalman  filter  estimates  to  produce  an  LQG  regulator. 


The  objective  of  the  controller  is  to  regulate  all  of  the  system 
outputs  to  zero,  without  expending  excessive  amounts  of  control  energy. 
The  determination  of  a  control  law,  of  the  form 


uC^)  =  -  G^t^x^)  (A— 7 ) 

which  meets  these  criteria  for  N  sample  periods  can  be  accomplished  by 
minimization  of  a  quadratic  cost  function  (performance  index)  of  the 
form 

N 

*  (4-8) 

where  Y_(t,),  Y-  and  U_(t.)  are  symmetric,  positive  definite  quadratic 

1  “U  X 

weighting  matrices  assigned  by  the  designer  in  order  to  achieve  the 
design  objectives  [30].  In  many  cases  (as  with  the  CGT/PI  controller) 
the  terminal  transient  can  be  ignored  and  time-invariant  weighting 
matrices  used  to  determine  a  more  easily  implemented  constant-gain 
steady-state  control  law 


u(t^)  s  -  (A— 9 ) 

through  the  minimization  of 
00 

J  =  y^1/2CjrT(ti  )j^y ( )  +  jfr(t1)j^(t1)]  ( A— 1 0 ) 

1=0  " 


A-4 


(A-11) 


J  =  2  J/2[x1(t1)XgX(t1)  +  u  (ti)JUsu(t1)] 
where,  in  view  of  (A-4), 


Xg  »  CTYgC  <A-12> 

Although  Yg  is  naturally  positive  definite,  (A-12)  reveals  that  Xg  may 
well  be  only  positive  semi-definite. 

In  the  case  of  a  controller  based  on  an  equivalent  discrete-time 
model  of  an  underlying  continuous-time  system,  it  is  often  convenient 
to  specify  the  cost  initially  as  a  continuous-time  function,  such  as 
those  used  for  the  example  model-following  development  of  Section  2.2. 
This  form  of  cost  can  then  be  discretized  [16,30]  to  produce  a 
discrete-time  cost  similar  to  that  in  (A-11),  but  generalized  to 
include  cross-weighting  terms  between  the  system  states  and  controls. 
Such  a  form  generally  arises  when  the  discrete-time  quadratic  cost 
function  is  developed  through  the  discretization  of  a  continuous-time 
cost  function,  even  if  the  continuous-time  function  contains  no 
cross-weightings  [30].  It  would  also  occur  if  (A-4)  were  modified  to 
admit  direct  feedthrough.  This  generalized  cost  function  is 


4 


xt^) 

u(tA) 


(A-13) 


where  S  is  the  cross-weighting  matrix;  JJg  is  still  assumed  positive 
definite  and  the  composite  matrix  in  (A-13)  is  assumed  positive 


semi-definite.  Based  on  such  a  generalized  quadratic  cost  function 


the  determination  of  the  constant-gain,  steady-state  control  law 
requires  only  the  solution  of  the  algebraic  matrix  Riccati  equation 
[303 


K 

— c 


T 

+  <P  K 


$  -  Cb:k£ 

i—  —Q.—C— 


JT.T„ 

S  3  ^ 


where 


G  = 
— c 


(A-14) 


(A-15) 


Software  is  available  for  the  efficient  solution  of  such  equations 
[233.  In  practice,  the  use  of  standard  matrix  Riccati  equation  solving 
routines  often  requires  that  the  weighting  matrix  of  ( A— 1 3 )  be  trans¬ 
formed  to  a  form  with  no  cross-weighting  term.  Once  the  solution  for 
the  transformed  system  is  found,  an  inverse  transformation  yields  the 
optimal  steady-state  control  law  for  the  original  system  [16,23,26,303. 


A. 3  A  Constant-Gain  PI  Regulator 

In  many  applications,  the  simple  regulator  developed  in  the 
preceding  section  is  not  suitable,  because  a  controller  is  needed  that 
will  regulate  the  system  outputs  to  non-zero  values.  Such  is  the  case 
of  the  CGT/PI  wherein  the  objective  is  to  cause  the  system  outputs  to 
match  the  model  outputs  represented  by  ^(t^)  of  (11-18).  An  addi¬ 
tional  objective  is  to  cause  the  error  quantity 

e^)  =  yU^  -  (II-19) 

to  be  zero  in  the  steady  state  despite  any  unmodelled  constant 
disturbances.  A  controller  which  can  satisfy  these  criteria  is  said  to 
have  the  "type-1  property"  that  can  be  achieved  with  a 


Proportional-plus-integral  (PI)  regulator  [8].  Such  a  regulator  can  be 
designed  by  applying  the  LQ  methodology  introduced  in  the  preceding 
section.  This  methodology  provides  a  systematic  synthesis  procedure 
for  a  multiple-input,  multiple-output  controller  which  ensures 
stability  under  design  conditions,  and  which  includes  the  appropriate 
crossfeeds  based  on  the  system  and  cost  descriptions.  By  iteratively 
adjusting  the  weights  used  in  the  quadratic  cost  function,  the  designer 
can  trade  off  state  and  control  amplitudes  so  as  to  achieve  performance 
specifications  [30]..  The  development  of  a  full-state,  constant-gain, 

LQ  perturbation  regulator  with  proportional-plus-integral  character¬ 
istics  follows;  this  deterministic  optimal  controller  can  be  cascaded 
with  a  Kalman  filter,  based  on  certainty  equivalence,  to  produce  the 
LQG  PI  regulator  [30]. 

The  system  of  (A-6)  is  unchanged  except  for  the  addition  of  a 
constant  disturbance,  d,  of  unknown  magnitude 

x(t1+i)  =  fcx^)  ♦  B^)  +  d  (A-16) 

and,  in  order  to  formulate  the  most  general  quadratic  cost  function, 
direct  feedthrough  of  the  inputs  to  the  outputs  is  allowed; 

y (t.  )  =  Cx(t.  )  +  D  u ( t.  )  (A-17) 

—  i  —  i  ~y~  i 

If^Ct^)  changes  slowly  in  comparison  to  the  response  time  of  the 

system,  then  the  development  can  be  made  based  on  a  constant  y  [30]. 

— m 

The  nominal  state  values,  x  ,  and  the  nominal  control,  u  ,  can  be 

~ o  — o 

determined  for  the  case  where  d  is  zero,  or 


y  s  Cx  +  D  u 
*-m  — o  — y^o 


( A— 1 9 ) 


(A-20) 


.  (A-21 ) 


x 

— o 


(A-22 ) 


u 

— o 


n224 


(A-23) 


The  case  where  d  is  non-zero  requires  the  definition  of  perturbation 
variables  that  reflect  deviations  from  the  nominal  conditions 


Ax(t  )  =  x ( t  )  -  x  =  x ( t  )  -  n  y  (A-24) 

—  1  —  i  — o  —  i  —  12-m 

AuC^)  =  uC^)  -  =  uCt^)  -  U.22^  (A— >25 ) 

iy(t, )  =  y(t  )  -  y  (a-26) 

—  X  —  1  “HI 


and 


ix(ti+1)  =  (A-27) 

*£(t =  Cix^)  +  Dyiut^)  (A-28) 


A -8 
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Since 


«u(ti+i)  -  fu^)  =  Cu(ti+1)  -  Uq]  -  [u^)  -  Uq]  (A-29) 

|u(titl)  s  JuO^)  +  Cu(t1+1)  -  uC^)] 

*  +  Au(ti)  (A-30) 

where  Ajj(t^)  is  a  "pseudorate"  that  provides  the  control  input  to  a 
perturbation  regulator  for  the  augmented  system.  Thus,  the  augmented 
perturbation  state  equation  is 

r^wi ,  \i  *j  r«<vi  u] 

|*u(ti+1)|  I  o  lJ|&u(t1)J  llj  1  (A-31) 


and  the  appropriate  discrete  time  cost  function  to  be  minimized  in 
defining  a  constant-gain  control  law  is  [30] 


As  in  case  of  the  simple  regulator,  the  required  gains  are  found  by 
solution  of  an  algebraic  Riccati  equation,  producing  an  incremental 
control  law  [30]: 

«u(t1+i)  =  Au^)  -  GclAx(t1>  -  (A-34) 

In  order  to  achieve  the  desired  "type-1  property"  a  signal 
proportional  to  the  pseudointegral  of  the  regulation  error  of  (11-19) 
must  be  added.  A  suitable  form  for  the  resulting  control  law  would  be 


A -9 


It  can  be  shown  [30]  that  both  (A-34)  and  ( A— 35 )  are  satisfied  if 


-x  s  — cl~ll  -=c: 


G-2%1 


(A-36) 


■— z  =  -^cl-12  +  ^2-22 


(A-37) 


If  ^  is  permitted  to  change  slowly,  so  that  the  system  essentially 
reaches  steady  state  before  each  subsequent  change,  the  final  PI 
regulator  control  law  becomes  [30] 


u(t, )  s  u ( t,  . )  -  K  [x(t  )  -  x(t  )]  +  K  [y  (t  )  -  y(t  )] 

—  1  —  1-1  — X  —  1  —  1-1  — Z  — HI  1  —  1-1 

(A-38) 


where  it  is  appropriate  that  the  time  arguments  of  the  last  term  do  not 
match  [30]. 


A. 4  Quadratic  Cost  and  Implicit  Model-Following  for  CGTPIV 

The  design  software  used  in  this  study  implements  a  PI  regulator, 
as  developed  in  the  preceding  section,  as  the  inner-loop  controller 
required  to  provide  stability  and  regulation  for  the  overall  CGT/PI. 
The  software  requires  the  designer  to  establish  continuous-time  models 
for  the  system  to  be  controlled;  equivalent  discrete-time  models  are 
developed  internally  by  the  program  [163.  Since  the  designer  works 
with  a  continuous-time  model,  the  software  also  requires  the  input  of 
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quadratic  weights  for  a  continuous-time  quadratic  cost  function.  In 
the  "standard"  PI  regulator  of  the  original  CGT/PI/KF  design  software 
[16],  which  is  still  an  option  of  the  current  version  [34],  implicit 
model-following  is  not  used;  the  continuous-time  cost  is  specified  in 
terms  of  a  Y  matrix  which  weights  output  deviations,  a  matrix  which 
weights  the  control  magnitudes,  and  a  matrix  which  weights  control 
rates.  The  continuous-time  cost  function  is 


J  =  1/2 


J[*yT(t)ya^(t)  +  *uT(t)I^|u(t)  +  Au^tJJJg^tJldt 
0 


(A— 39 ) 


The  Y  and  matrices  are  then  combined  with  the  output  and  feedthrough 


matrices  to  develop  an  X  matrix: 
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where 
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— ell - 
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The  continuous-time  cost  function  therefore  becomes 


(A-4 1c) 
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The  program  then  discretizes  the  continuous-time  cost  function  to 
produce  the  discrete-time  cost  function  of  (A-33)  [16].  This  process 
also  introduces  the  required  discrete-time  cross-weightings. 

The  developments  so  far  in  this  Appendix  have  not  addressed  the 
incorporation  of  the  implicit  model-following  concept  that  was  used  so 
extensively  in  this  study.  The  example  development  in  Section  2.2 
demonstrates  that  a  continuous-time  quadratic  cost  function  incorpora¬ 
ting  an  implicit  model  can  be  easily  formulated.  If  the  objective  of 
the  controller  is  to  achieve  simple  regulation  of  outputs,  then  the 
development  of  Section  2.2  can  be  applied  to  the  sampled-data 
controller,  as  well;  discretization  [16,30]  of  (II-5b)  would  result  in 
a  cost  function  of  the  same  form  as  (A-13),  but  with  weighting  matrices 
appropriate  for  an  implicit  model-following  regulator. 

The  development  of  implicit  model-following  for  the  PI  regulator 
is  also  easy  to  envision  in  the  context  of  a  continuous-time  cost,  such 
as  (A-39)>  If  the  objective  of  the  controller  developed  in  the 
preceding  section  is  changed  from  regulating  the  perturbation  outputs, 
defined  as 


tt(t>  -  2(t)  -4 


(A— 26 ) 


to  zero,  to  that  of  forcing  those  outputs  to  mimic  the  dynamics  of  a 
model  system,  so  that 


iy (t)  s  a  ay(t) 
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(ii— 4 ) 


then  the  appropriate  continuous-time  cost  function  would  become 
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Note  that  (A-45)  is  identical  in  form  to  (II— 6) ,  but  that  (A-43) 
through  (A-45)  are  presented  in  notation  consistent  with  CGTPIV  and  the 
discussions  of  Chapters  IV  and  V. 

The  design  path  in  CGTPIV  that  permits  the  use  of  implicit 
model-following  actually  implements  a  "combined  explicit-implicit" 
regulator,  based  on  a  continuous-time  cost  function  that  results  from 
combining  (A-39)  and  (A-43)  (34).  The  designer  has  the  freedom  to 


specify  the  implicit  regulator  command  model  as  well  as  jf,  U^,  , 

and  Rj.  For  the  "  all-implicit"  designs  in  this  study,  J£  and  %  were 

set  to  zero.  For  the  general  combined  case,  instead  of  using  the  X 

matrix  of  (A-40)  in  the  cost,  as  in  (A-42),  a  combined  state  weighting 

matrix,  X ,  is  developed  in  CGTPIV  by  adding  the  implicit  state 
—IE 

weightings  to  X  prior  to  discretizing  the  cost: 


The  combined  continuous-time  cost  function  is,  therefore 
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A. 5  Summary 

This  appendix  reviewed  the  formulation  of  basic  LQG  optimal 
regulator  design  methods  that  were  used  in  developing  the  software  that 
produced  the  designs  of  this  study.  The  purpose  was  to  ensure  an 
adequate  framework  upon  which  to  build  an  understanding  of  implicit 
model-following,  and  to  relate  the  notation  and  terminology  used  in 
Chapters  IV  and  V,  as  well  as  that  of  the  CGTPIV  design  software,  to 
that  theoretical  framework.  The  fora  of  the  PI  regulator  control  law 
of  (A-35)  and  of  the  CGT/PI  control  law  of  (11-25)  is  independent  of 
whether  the  PI  regulator  gains  are  found  by  minimizing  the  "standard" 
cost  of  (A-39),  the  "implicit"  cost  of  (A— 43 )  or  a  combination  of  the 
two.  However,  as  seen  in  the  results  of  this  study,  the  incorporation 
of  an  implicit  model  in  the  design  of  the  regulator  has  a  substantial 
beneficial  effect  on  the  closed-loop  characteristics  of  the  resulting 


controller 


B.  CGTSVD  Software  Description  and  Instructions 


B.  1  Introduction 

CGTSVD  is  an  interactive  computer  program,  developed  for  use  in 
this  study,  which  calculates  the  minimum  and  maximum  singular  values  of 
the  loop  and  inverse  return  difference  matrix  functions  for  any 
CGT/PI/KF  or  CGT/PI  controller.  This  appendix  develops  the  equations 
employed,  and  discusses  the  structure  and  use  of  CGTSVD;  the  informa¬ 
tion  provided  is  intended  to  enhance  the  reader's  ability  not  only  to 
understand  and  use  the  software,  but  to  modify  it  easily,  if  necessary. 
A  short  sample  execution  of  the  program  is  included,  as  is  a  complete 
listing  of  the  source  code. 

CGTSVD  was  intentionally  developed  without  the  use  of  the  sophis¬ 
ticated  programming  practices  which  made  CGTPIV  so  efficient  in  terms 
of  storage  requirements  and  execution  time  [16].  Due  to  the  compara¬ 
tively  small  scope  of  the  computational  task,  it  was  obvious  at  he 
outset  that  such  practices  would  not  be  required  in  order  to  achieve  a 
load  size  compatible  with  the  normal  interactive  memory  limits  (either 
65*000  or  100,000  octal  words  of  storage)  established  for  the  Aeronau¬ 
tical  Systems  Division's  CYBER  computer.  On  the  other  hand,  a  degree 
of  structural  complexity  was  foreseen  due  to  the  effort  to  make  the 
program  as  general  as  possible,  able  to  handle  a  variety  of  calcu¬ 
lations  for  a  wide  range  of  problems.  For  those  reasons,  the  simplest 
programming  methods  were  selected,  so  as  to  produce  a  source  program 
that,  although  relatively  inefficient,  should  be  easily  interpreted  by 
anyone  with  experience  in  FORTRAN  programming.  The  program  is  written 
in  ANSI  standard  FORTRAN  77*  and  the  source  code  includes  many  comments 


B-1 


,'.V 


which  explain  what  each  segment  of  code  does  and,  in  many  cases,  how  it 


is  done.  The  program  executes  interactively,  and  prompts  are  suffi¬ 
cient  in  number  and  detail  to  lead  a  novice  user  along  the  proper 
paths.  Because  the  source  code  is  simple  and  reasonably 
self-explanatory,  the  discussion  of  the  structure  and  use  of  the 
program  is  brief. 

B.2  Development  of  Loop  Equations 

This  section  develops  the  equations  used  in  CGTSVD  for  calculating 
the  loop  gain  matrix  function  of  a  closed-loop  CGT/PI  or  CGT/PI/KF 
controller.  The  use  of  the  loop  gain  and  inverse  return  difference  (a 
function  of  the  loop  gain)  matrix  functions  in  robustness  analysis  is 
discussed  at  length  in  Section  3*2. 

The  overall  control  law  for  the  closed-loop  CGT/PI  controller  is 
given  in  (11-25).  Since  the  loop  gain  does  not  include  the  effects  of 
any  quantities  outside  of  the  closed  feedback  loop,  the  command  model 
states  and  commanded  control  inputs  of  (11-25)  need  not  be  considered. 
Additionally,  the  disturbance  states  only  become  a  part  of  the  loop  if 
a  Kalman  filter  is  included  to  provide  disturbance  state  estimates  to 
the  CGT  controller.  Unless  stated  otherwise,  all  of  the  quantities  in 
the  following  development  are  as  defined  previously  in  Section  2.3* 

For  the  LQSF  (CGT/PI)  controller,  calculation  of  the  loop  gain 
function  is  quite  simple  once  the  quantities  outside  the  feedback  loop 
have  been  stripped  from  the  control  law.  The  remaining  portion  of  the 
control  law  relates  the  system  inputs  to  the  system  states: 


V  *»'.*,*> 


%  •- 


uCt^  -  u(ti_1)  =  -  KxCx ( t± )  -  x(t1_1)] 

-  +^Ji(t1_1)] 


Transferring  this  difference  equation  to  the  z-domain  [8], 


u(z)  -  u(z)/z  =  -  K  [x(z)  -  x(z)/z]  -  K  [Cx(z)/z  +  Du(z)/z] 

“  "  ■ X  Z  ” j~” 


(B-1) 


(B-2) 


The  PI  controller  "gain"  representing  the  ratio  of  system  inputs  to 


system  states  is,  therefore. 


K(z)  =  [ (z-1 )I  +  K  D  ]_aC(1-z)K  -  K  C] 

—  —  — z-y  —x  -z— 


(B-3) 


The  plant  "gain"  representing  the  ratio  of  system  states  to  system 
inputs  is  the  Z  transform  [8]  of  the  product  of  a  zero-order  hold  (a 
device  used  to  change  the  discrete  control  input  at  time  t^  into  a 
continuous  input  signal,  held  constant  over  the  sample  period,  which 
drives  the  continuous-time  plant  [8])  and  the  s-domain  representation 
of  the  continuous-time  plant  transfer  function.  In  the  s-domain,  the 
zero-order  hold  device  is  represented  as 


ZOH  s  [1  -  e~sT]/s 


where  T  is  the  controller  sampling  interval.  The  plant  transfer 
function  is 


*(s)B  =  [si  -  A]  B 


(B-4) 


(B-5) 


where  A  and  B  are,  respectively,  the  continuous-time  dynamics  and 
control  matrices  that  make  up  the  "evaluation  model."  The  combined 
zero-order  hold  and  plant  is  therefore 


_G(z)  =  Z  transform  {[1  -  e”s^]/s  [s_I  -  A]  x B  }■ 


(B-6) 


and  the  loop  gain,  with  the  loop  cut  at  the  control  input,  is 


G^z)  =  K(z)G(z) 


(B-7a) 


and  with  the  loop  cut  at  the  output. 


Gl(z)  =  G(z)K(z)  (B-7b) 

In  the  implementation  in  CGTSVD,  the  user  may  specify  the  use  of  an 
"evaluation  model”  consisting  of  either  the  design  model  or  a  truth 
model  description  of  the  plant,  which  may  be  of  higher  dimension  than 
the  design  model.  When  the  truth  model  option  is  used,  a  transfor¬ 
mation  matrix  must  also  be  supplied  which  premultiplies  the  G(z) 
function  so  as  to  reduce  the  truth  model  state  vector  to  the  same 
dimension  as,  and  quantities  equivalent  to,  the  design  model  state 
vector,  thus  making  it  compatible  with  the  control  law.  The  actual 
calculation  of  the  loop  gain  singular  values  is  accomplished,  for  each 
frequency,  in  the  frequency  («)  domain,  using  the  relationships  [8] 


3  = 


(B— 8 ) 


and 


(B-9) 


The  corresponding  development  for  the  CGT/PI/KF  is  more  compli¬ 
cated  due  to  the  need  to  calculate  a  "gain"  or  transfer  function  for 
the  Kalman  filter  as  well  as  the  inclusion  of  the  disturbance  state 


estimates  in  the  control  law.  In  the  development  that  follows, 


quantities  that  are  filter  estimates  are  depicted  using  a  "hat"  (A) 
notation.  The  portion  of  the  control  law  relating  the  control  inputs 
to  the  state  estimates  is 


u^)  -  u(ti_1)  = 


*4n[Sd(tl>  -  VW1 


(B-10) 


Transforming  this  difference  equation  to  the  z-domain  and  collecting 
terms  yields 


t(z-1)I  +  KD  ]u(z)  =  [K  (1-z)  -  K  C]x(z)  +  K  t(z-1)n  (z)] 
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Defining  an  augmented  state  vector 
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(B-12) 


[(s-UI  +  KaPy)u(z)  =  j[Kx(1-z)  -  K^C]  |  [K^U-I)]  j 

(B-1 3) 

so  that  the  ratio  of  control  inputs  to  augmented  state  estimates  is 

JO  (z)  s  [(z-1)I  +  K  D  I’1  5  [K  (1-z)  -  K  C]  ;  [K  (z-1)]f  (B-14) 

The  overall  "gain"  or  transfer  function  of  the  Kalman  filter  can 
be  calculated  from  the  propagation  and  update  equations  for  the  filter 
[293.  If  a  truth  model  state  vector,  x.  (t,  ),  is  defined  so  as  to 

“X  I 

include  the  "true"  system  and  disturbance  states,  then  the  truth  model 
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measurement  vector  Is 


13 


W  =  4W  +  W 


(B— 15) 


and  the  design  model  measurement  vector  upon  which  the  filter  design  is 
based  is 


z(t  )  =  H.x_ (t, )  +  v(t. ) 
—  -a-a  i  -  l 


(B— 16) 


where 


H  =  [H  ;  H] 
—a  —  i  — n 


(11-27) 


Using  to  denote  the  Kalman  filter  gain. 
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Since  the  measurement  noises  are  outside  of  the  loop,  they  can  be 
dropped  from  the  loop  calculations,  so  that 
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Also, 
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Note  that  in  (B-20c),  not  fche  constant  4^  as  in  (B-20a), 

but  is  a  variable  in  r. 

Z-transforming  (B— 1 8)  and  (B-19b)  and  using  (B-14)  to  eliminate 
u(z)  from  the  result  gives  a  transfer  function  relating  the  augmented 
system  state  estimates  to  the  truth  model  state  realizations: 
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The  existence  of  the  disturbance  state  estimates  within  the  loop 
is  entirely  accounted  for  , in  (B-14)  and  (B-21).  The  shaping  filters 
for  the  disturbance  states  are  outside  the  loop,  so  those  states  need 
not  be  represented  in  the  plant  evaluation  dynamics  model.  The  plant 
may  again,  therefore,  be  represented  by  an  equation  of  the  form  of 
(B-6)  where,  in  this  case,  the  A  and  B  matrices  of  the  "evaluation 


w 


in 


model”  represent  the  partitions  of  the  model  dynamics  and  control 
matrices  associated  with  system  states  (i.e.,  excluding  disturbances). 
For  the  ”filter-in-the-loop"  calculations,  when  the  evaluation  model 
state  dimension  exceeds  that  of  the  design  model,  the  matrix 
provides  the  necessary  interface  with  the  control  law,  and  no  addi¬ 
tional  transformation  is  required.  Also,  since  the  disturbances  are 
not  represented  in  the  plant  model,  only  the  columns  of  the  matrix 
associated  with  system  states  need  be  included  in  the  calculations 
(again,  the  disturbance  states  can  be  dropped).  The  overall  loop  gain, 
with  the  loop  cut  at  the  control  input,  is  therefore 

Gl(z)  =  K1(z)K2(z)G(z)  (B-22a) 

and  with  the  loop  cut  at  the  output, 

GL(z)  =  G(z)K^z)K2(z)  (B-22b) 

Once  again,  the  actual  calculations  in  CGTSVD  are  conducted  in  the 
w-domain . 

B.3  CGTSVD  Program  Structure 

With  the  exception  of  the  LINPACK  [9]  library  routine  CSVDC,  which 
is  used  to  find  the  singular  values  of  complex  matrices,  the  program 
CGTSVD  is  entirely  self-contained.  In  the  interest  of  simplicity, 
rather  than  efficiency,  the  majority  of  the  calculations  are  conducted 
using  complex  arithmetic  and  with  complex  variable  types.  To  allow  the 
matrix  manipulation  subroutines  to  operate,  as  simply  as  possible,  on 
partitions  of  larger  arrays  and  on  matrices  of  varying  sizes,  nearly 
all  of  the  arrays  in  the  main  program  and  the  subroutines  are  blocked 


with  a  common  row  dimension  of  16.  Despite  the  lack  of  effort  to  limit 
array  storage  requirements,  the  program,  as  listed  in  Section  B.6,  will 
handle  problems  with  up  to  16  augmented  design  model  states  (system 
states  plus  disturbance  states,  of  which  there  may  be  8),  16  truth 
model  system  states  and  8  each  control  inputs  and  system  outputs,  while 
using  70,000  (octal)  words  of  core  memory. 

The  majority  of  the  variable  names  used  in  the  program  (exclusive 
of  work  arrays)  are  reasonably  well  defined  either  by  the  comments  in 
the  source  code,  by  the  wording  of  the  prompts  that  precede  their 
definition  by  the  user,  or  by  their  context.  The  flow  of  the  program 
assumes  that  the  design  parameters  will  be  read  in  from  a  previously 
established  data  file  (line  780  of  the  source  listing).  If  a  data  file 
is  not  used,  the  program  branches  to  line  2600,  where  the  parameters 
are  entered  from  the  terminal  (this  section  of  code  is  perhaps  the  best 
place  to  get  familiar  with  the  variable  names  used  for  the  design 
parameters).  Regardless  of  the  way  in  which  the  parameters  are 
entered,  the  user  is  given  the  option  of  changing  any  parameters  via 
the  "change  menu”  at  line  1300  prior  to  each  set  of  singular  value 
calculations.  As  noted  in  the  source  listing,  the  logic  followed  in 
implementing  changes  is  probably  the  most  difficult  to  follow,  since  it 
requires  jumping  around  through  the  data  entry  sequence  to  pick  up  all 
of  the  required  information,  without  requiring  the  user  to  reenter  data 
that  does  not  change.  Once  the  design  parameters  have  been  defined, 
the  program  branches  to  line  3950  to  calculate  singular  values  for  the 
CGT/PI  or  to  line  5110  for  the  CGT/PI/KF,  as  specified  by  the  user. 

The  program  is  terminated  by  a  menu  selection  at  line  1300. 

In  its  current  form,  the  program  will  calculate  either  the  loop 


gain  or  inverse  return  difference  function  singular  values,  with  the 
loop  cut  at  either  the  control  input  or  plant  output.  When  the  loop  is 
cut  at  the  plant  output,  the  loop  gain  is  generally  rank  deficient  (the 
matrix  is  square,  with  dimension  equal  to  either  the  design  or  evalua¬ 
tion  model  state  dimension  but  with  rank  equal  to  the  control  input 
vector  dimension).  In  such  a  case  a  pseudoinverse  of  the  loop  gain 
matrix  is  used  in  calculating  the  inverse  return  difference  function. 

If  an  attempt  is  made  to  invert  any  rank  deficient  matrix  under  any 
other  circumstances,  the  calculation  is  aborted,  the  user  is  advised, 
and  the  program  returns  to  the  "change  menu"  (line  1300). 

The  program  produces  printer  plots,  displayed  at  the  user  terminal 
and  written  to  a  plot  file,  of  the  logarithms  of  the  absolute  values  of 
the  minimum  and  maximum  singular  values  for  the  selected  function, 
versus  radian  frequency.  Each  plot  includes  2  decades  of  frequency,  or 
37  points.  To  change  the  number  of  points  per  plot,  it  is  only 
necessary  to  change  the  references  to  "37"  in  lines  390,  3950,  5200, 
6510  and  6620  to  the  desired  number  and  increase  the  size  of  the 
"PLTVEC"  array  in  line  390  to  3  times  the  new  number  of  points;  for 
example,  55  (vice  37)  would  produce  a  plot  covering  3  decades  at  the 
same  frequency  intervals.  If  the  number  of  desired  points  exceeds  60, 
lines  11310  through  11330  should  be  deleted  or  modified,  as  they  are 
designed  to  pad  the  line  printer  output  to  one  full  page  per  plot.  The 
frequency  interval  may  also  be  changed  to  affect  the  number  of  decades 
covered;  for  example,  changing  the  20.0  in  lines  4960  and  6400  to  10.0 
will  halve  the  number  of  points  plotted  per  decade.  If  the  actual 
magnitude  of  the  singular  values  is  desired  rather  than  the  logarithm, 
the  "L0G10"  may  be  deleted  in  lines  4580,  4600,  4880,  4900,  6000,  6020, 


6320  and  6340.  The  array  dimensions  may  be  altered  to  handle  larger 
problems  or  reduce  the  load  size,  so  long  as  the  following  are 
observed: 


—  All  of  the  arrays  which  are  currently  blocked  with  a  row 
dimension  of  16  in  the  main  program  and  subroutines  must  always  have 
the  same  common  row  dimension. 

—  All  of  the  two-dimensional  "WORK"  arrays  should  remain  square. 

B.4  Instructions  for  Using  CGTSVD 

Prior  to  executing  CGTSVD,  any  data  files  established  during 
previous  sessions  with  the  program  should  be  attached,  if  they  are  to 
be  used  to  define  the  design  parameters.  The  program  will  allow 
repeated  problem  parameter  redefinition  through  the  use  of  multiple 
data  files  and  keyboard  inputs.  Data  files  are  distinguished  by  their 
file  names,  which  are  specified  by  the  user.  The  data  files  for  CGTSVD 
are  not  compatible  with  those  of  ODEACT  or  CGTPIV.  Each  time  the 
problem  is  redefined,  the  user  is  given  the  opportunity  to  save  the 
data  to  a  new  file;  the  program  will  not  overwrite  a  previously 
established  data  file.  The  LINPACK  subroutine  library  must  also  be 
attached  and  declared  as  a  library  prior  to  execution  of  CGTSVD. 

Once  program  execution  is  begun,  the  user  need  only  respond  to  the 
prompts  for  option  selection  and  data  input.  The  prompts  are  quite 
explicit  as  to  what  should  be  included  with  each  entry.  When  a  matrix 
is  to  be  newly  defined  via  keyboard  input,  the  entire  matrix  must  be 
entered,  one  row  at  a  time,  with  the  elements  of  the  row  separated  by 
commas  or  spaces.  When  changes  to  a  matrix  are  made,  only  the  elements 
that  are  being  redefined  need  be  entered,  in  the  format  specified  by 
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V  V  V  V 

.  mJ.  *..!  fcl  aAfc  * 


the  prompt. 

The  design  and  truth  model  dynamics  and  control  matrices  are 
entered  in  their  continuous-time  forms,  as  they  are  in  CGTPIV.  The 
continuous-time  design  model  dynamics  representation  of  the  controlled 
system  is  [16] 


x(t)  =  Ax<t)  +  Bu(t)  +  E^n^t)  +  Gw(t) 


n,(t)  a  An, (t)  ♦  Gw  (t) 
— d.  — n— a  — n—n 


(B-21 ) 
(B-22) 


so  that  when  the  program  asks  for  the  augmented  design  model  dynamics 
matrix,  the  appropriate  entry  is  of  the  form 


’  A 

!  E 

0 

!  A 

m 

i  — n  _ 

A  = 


and  the  design  model  control  matrix  is 


(B-23) 


B_  a 


B 

0 


(B— 1 8b ) 


If  a  truth  model  is  used  as  the  "evaluation  model"  it  is  entered 
without  any  augmenting  disturbance  states.  This  means  that  the 
evaluation  model  dynamics,  transformation,  control  and  measurement 
matrices  are  to  be  stripped  of  all  partitions  relating  to  disturbance 
states.  Assuming  that  previous  prompts  for  model  dimensions  were 
answered  oorrectly,  the  matrix  entry  prompts  also  provide  reminders  as 
to  the  correct  dimensions  for  the  models  being  entered.  When  the 
design  model  is  used  as  the  evaluation  model,  no  evaluation  model 


inputs  are  required 


For  designs  in  which  the  number  of  control  inputs  exceeds  the 
number  of  controlled  outputs,  the  correct  response  to  the  "ENTER  NUMBER 
OF  OUTPUTS"  prompt  may  be  either  the  actual  number  of  outputs  or  the 
number  of  control  inputs.  The  entry  that  is  used  will  define  the 
number  of  rows  of  £  and  D  (if  used)  as  well  as  the  number  of  columns 

y 

of  that  the  input  routines  will  expect.  The  only  reason  for 

choosing  to  enter  the  number  of  controls  instead  of  the  actual  number 

of  outputs  would  be  so  that  the  C,  D  ,  and  K  matrices  would  be  the 

—  — y  —z 

same  as  for  the  input/output  of  CGTPIV,  where  the  number  of  outputs 

must  equal  the  number  of  controls  [16].  In  such  a  case,  the  "extra" 

rows  of  C  and  D  and  columns  of  K  will  all  be  made  up  of  zeroes,  and 
—  — y  — z 

do  not  affect  the  singular  value  calculations.  When  the  actual  number 
of  outputs  is  entered  in  response  to  the  prompt,  these  extra  entries 
are  not  required.  If  the  number  of  controlled  outputs  exceeds  the 
number  of  control  inputs  (as  was  the  case  of  the  controllers  in  Section 
5.5),  the  appropriate  response  to  the  "ENTER  NUMBER  OF  CONTROLS"  prompt 
is  the  actual  number  of  control  inputs  available;  in  other  words,  no 
"dummy"  controls,  as  used  in  CGTPIV,  are  required  by  CGTSVD.  They 
will,  in  fact  result  in  an  abort  of  the  calculations  due  to  rank 
deficiency  in  the  loop  matrix. 

To  terminate  the  program,  a  "Y”  response  should  be  given  to  the 
"ANY  CHANGES  TO  DATA"  prompt;  the  "change  menu"  includes  the  option  to 
exit  the  program.  All  of  the  singular  value  plots  displayed  at  the 
terminal  are  automatically  written  to  an  output  file,  which  is  named  by 
the  user.  This  file  may  be  saved  for  future  reference  or  routed  to  a 
line  printer  to  obtain  a  "hard"  copy. 


B.5  Sample  Program  Execution 

The  next  few  pages  contain  the  terminal  output  from  a  short  sample 
run  of  CGTSVD  on  the  CYBER  computer.  The  object  code  is  contained  in 
the  file  CGTSVD  and  the  file  AFTI5F  contains  data  for  the  SR-B  CGT/PI 
design  defined  in  Section  5.2.  The  computer's  prompts  and  outputs  are 
displayed  in  upper  case,  and  the  non-numeric  user  responses  in  lower 
case  type. 


COMMAND-  attach, aftiSf 


PFM  IS 
AFTI5F 

AT  CY«  Ml  SN*AFIT 

COWHAND*  attach, cgtsvd 

PFM  IS 
CGTSVD 

AT  CY*  Ml  SN*AFIT 


COHWAND-  attach, Unpack, id»library,sn»asd 
PFM  IS 

unpack: 

AT  CV*  999  SN*ASD 
COMMAND-  library, Unpack 
COMIAND-  cgtsvd 

ENTER  NAME  FOR  PLOT  OUTPUT  FILE:  plflti 

DATA  INPUT  FROM  TAPE?  Y/N:  y 

ENTER  NAME  OF  LOCAL  FILE:  afti5f 

CURRENT  STATUS:  NO  KALIMN  FILTER 
EVALUATION  TRUTH  MODEL  *  DESIGN  MODEL 
ANY  CHANGES  TO  DATA?  Y/N:  n 

ENTER  SAMPL1N6  TIME  INTERVAL:  .12 

ENTER  STARTING  FREQUENCY  (RADIANS)  AS  A  PONER  OF  If:  f 

1«  SINGULAR  VALUES  OF  LOOP  MATRIX 

2*  SINGULAR  VALUES  OF  INVERSE  RETURN  DIFFERENCE  MATRIX 

ENTER  CHOICE  I:  2 

1»  LOOP  CUT  AT  CONTROL  INPUT 
2*  LOOP  CUT  AT  PLANT  OUTPUT 
ENTER  CHOICE  «:  1 

* - ENTER  TITLE  FOR  PLOT - + 

saaplt  plot  for  sr-b  design 

1  >  SINGLE  PLOT,  SINGLE  SCALE 

2  *  TNO  PLOTS  -  ONE  SINGLE  SCALE,  ONE  DOUBLE  SCALE 

3  *  SINGLE  PLOT,  DOUBLE  SCALE 
SPECIFY  TYPE  OF  PLOT:  1 


SAMPLE  PLOT  FOR  SR-B  DESIGN 


i.Mfl 

2 

1  * 

+ 

l.Sfff 

♦  2 

♦1 

2.  BIN 

♦  2 

*  1 

♦ 

2.5NI 

♦ 

2  ♦  1 

♦ 

3. BAN 

♦ 

2  ♦ 

1  ♦ 

3.  SIN 

♦ 

2  ♦ 

1  ♦ 

4.NN 

♦ 

2 

l  ♦ 

4.3BN 

♦ 

♦2 

1  ♦ 

S.NN 

♦ 

♦  2 

1+ 

3.3BN 

+"  * 
T»  • 

•  •  • 
•  •  «Ti  X  t 

•  ♦  ji  • 

6.  BIN 

♦ 

♦  2 

♦1 

4.5 Nf 

♦ 

♦  2 

!  *1 

7.BNB 

♦ 

+ 

2  ♦  l 

7.5MB 

♦ 

♦ 

2  *  1 

8.BBN 

♦ 

♦ 

2  ♦  1 

8.3BN 

♦ 

+ 

2  ♦  l 

9.  MM 

♦ 

♦ 

2+ 

9.  SIM 

♦ 

+ 

2* 

IB.  INI 

♦ 

♦ 

2 

IS.  MM 

:  : 

2B.MM 

♦ 

♦ 

♦ 

25.8MB 

♦ 

♦ 

♦ 

Zt.  MM 

* 

* 

33.BMB 

* 

♦ 

♦ 

4B.MM 

♦ 

♦ 

45.1MB 

♦ 

+■ 

♦ 

SB.BMB 

♦ 

♦ 

♦ 

33.BMB 

♦ 

♦ 

♦ 

4B.MM 

♦ 

♦ 

♦ 

45.MM 

*•  •  ■ 
T«  •  « 

■  iii  i 
•  • T*  ■ 

71. MM 

♦ 

♦ 

♦ 

73.  MM 

♦ 

♦ 

♦ 

8B.MM 

♦ 

♦ 

♦ 

83.1MB 

♦ 

♦ 

+ 

91.  IBM 

♦ 

♦ 

♦ 

93.  MM 

♦ 

♦ 

♦ 

IBB.  MM 

♦ 

♦ 

♦ 

SCALE  - 

•  1IBE+M 

.58BE+M 

. 11BE+I1 

Iff*  PROGRAM  C6TSVD 

li««C 

13f*C 

14W  PR06RAM  TO  CALCULATE  HlNIItUN  AND  NAXINUN  SINGULAR  VALUES  OF 
15#*C  THE  LOOP  AND  INVERSE  RETURN  DIFFERENCE  RATRIX  FUNCTIONS  FOR  A 
16f*C  CGT/PI/KF  CONTROLLER.  USER  SUPPLIES  COMPLETE  DESIGN  AND  TRUTH 
17I*C  NODa  SPECIFICATIONS  AS  HELL  AS  CONTROLLER/FILTER  GAINS. 

18#*C  OPTIONS  INCLUDE: 

19#*C  1.  LOOP/INVERSE  RETURN  DIFFERENCE  FUNCTION  SIN6ULAR  VALUES 

2##*C  2.  LOOP  CUT  AT  CONTROL  INPUT  OR  PLANT  OUTPUT 

21W  3.  AODITION/RENOVAL  OF  TRUTH  MDEL 

22#*C  4.  AODITION/RENOVAL  OF  KALMAN  FILTER 

23f*C 

24W  DATE  OF  LAST  REVISION:  16  OCT  S3 

25B-C  LIBRARIES  USED:  LINPACK,  ID-LIBRARY,  SN>ASO 

26i*C 

281*0 

291*  COMPLEX  ANORK(lGllG)lBNORK(lGliG)lCNORK(lG,16}fDNORK(lGllG) 

3M*  COMPLEX  AHATE  (16,16) ,  KXNHAT  ( 16, 8) ,  DYHAT  ( 14,  B) ,  BHATE 1 16, 8) 

311*  COMPLEX  PHIDSCI16, 16) , BDSC ( 16, B> , SV <  16)  f WORK!  16) , E  ( 16) 

32f*  COMPLEX  ZIDENT < 16, 16) , ZOH, Z , S,  ZLESS, U ( 16, 16) , V ( 16, 16) 

331*  COMPLEX  AIMT(16, 16) f TDTHAT<16y 16) fBHAT416f 8) f CHAT(16f 16) 

34#*  COMPLEX  HMAT ( 16, 16) ,XF6AIN<16, 16) ,KXHAT (16,16), KZNAT (16,8) 

33f*  COMPLEX  HHATE<16,16) 

361*  INTEGER  INlINDN,INDlS,IRtIPlIHlINAStKFLA6,JFLA6 

371*  INTEGER  INEAS, Lf LAG, NFLAG, INFO, INST, I , J, X 

381-  INTEGER  NFLAG, INFLAG, I 1FLAG, I2FLAG 

39#*  REAL  MAD, TSANP, DELN, HINC, RESULT <37,3), PLTVEC <12#> 

4M*  REAL  SCRACH416, 16) 

41#*  CHARACTER  ANSN*1,TITLE*5#,SAVE*6,DATA*6,PL0T*6 

42#*C 

44#*C 

43I*C  FLAG  DEFINITIONS: 

46f*C  II FLAG  *  MENU  CHOICE  FOR  CHANGES  (I  MEANS  NONE) 

47I*C  I2FLA6  *  MENU  CHOICE  FOR  EDITING  MATRICES 

48«*C  JFLAG  *  CHOICE  OF  LOOP  FUNCTION  (1)  OR  INVERSE  RETURN  DIFFERENCE  (2) 

49#*C  KFLAG  «  1  IF  KALMAN  FILTER  IN  LOOP  (f  IF  LOSF) 

3ff*C  LFLA6  *  1  IF  LOOP  CUT  AT  CONTROL  INPUT  (2  IF  AT  OUTPUT) 

51f*C  NFLAG  >  NONZERO  IF  ATTEMPT  MADE  TO  INVERT  SINGULAR  MATRIX 
32f*C  MFLA6  *  1  IF  TRUTH  MODEL  USED  (I  FOR  DESIGN  NODa) 

53f*C  INFLAG  *  MAX  NUMBER  OF  BAB  SINGULAR  VALUES  FROM  CSVDC 
34#*C 

SWtHHHHHHHHHUHHHHHHHIHWHWIHHHHWHHHHMHH 

36f*C 

371*  KFLA6*f 

SGI*  HFLA6*f 

391*  NFLAG*# 

6M*C 

62f*C 

63f*C  PLOTS  ARE  AUTOMATICALLY  SAVED  TO  TAPE  (PLOT) 


66f*C 

671*  5  PRINT*,’ ENTER  NAME  FOR  PLOT  OUTPUT  FILE:  ’ 

681*  READ!*,’ (A)’) PLOT 

691*  OPEN(4,FILE*PLOT,STATUS*’NEN’ , FORM* ’FORMATTED’ ,ERR*5) 

7N*C 


72f*C 

73»*C  THIS  SECTION  ALLOHS  PROBLEM  DATA  ENTRY  FROM  KEYBOARD  OR  TAPE  (DATA) 
74#*C  AND  SAVIN6  PROBLEM  DATA  TO  TAPE  (SAVE) 

75W 


70#*  II  PRINT*, ’DATA  INPUT  FROM  TAPE?  Y/N:  ’ 


79f*  READ!*,' (A)’)ANSH 

811s  IF  ( ANSN.NE.’Y’. AND. ANSN.NE.’N’) THEN 

811s  60  TO  If 

821*  END  IF 

831*  IF  (ANSN.EQ.*N*)60  TO  IN 

n  tm-r 

OlPfc 

83#*C  SECTION  TO  READ  PROBLEM  DATA  FROM  TAPE 
BA#*C 

871*  21  PRINT*, ’ENTER  NAME  OF  LOCAL  FILE:  ’ 

881*  READ!*,’ (A(’)DATA 

891*  OPEN (3, F ILE*DATA, STATUS*’ OLD’ ,FORH*’ UNFORMATTED’ ,ERR*2f ) 

9N=  READ(3)KFLA6,NFLA6,  INDH,  INDIS,  IMS,  IR,  IP 

911*  READ (3) ( (ANAT(I, J), 1*1, INDH), J*l, INDH) 

921*  READ (3) ( (BHAT(I, J) , 1*1 , INAS) , J*1 , IR) 

931*  READ(3)((CHAT(I,3),I*1,IP),3*1,INAS) 

941*  READ (3) ( (DYHAT ( I , J ) , I«l , IP) , 3*1 , IR) 

951*  READ ( 3) < (KXNAT ( I , 3 ) , 1*1 , IR) , 3*1 , INAS) 

961*  READ (3) ( (KZHAT ( I , 3) , I«l, IR) , 3*1 , IP) 

971*  IF(KFLA8.EB.1)THEN 

981*  READ(3)IM 

991*  READ(3)  ( (WAT  ( 1 , 3) , 1*1, IH) , 3*1 ,  INDH) 

1«N*  READ(3)((KF6AIN(I,J), 1*1, INDH), J*1,IH) 

lllf*  READ (3) ( (KINHAT ( 1,3) , 1*1 , IR) , 3*1 , INDIS) 

1121*  END  IF 

1131*  25  IF (NFLA6. EQ. 1 ) THEN 

1141*  READ13) INEAS 

1151*  READ  (3)  ( (AKATEd  ,3), 1*1, INEAS), 3*1,  INEAS) 

1161*  READ (3)  ( (BflATE  1 1, 3) ,  1*1,  INEAS)  ,3*1,  IR) 

1171*  READ (3) ( (TDTHAT I I ,3) , 1*1 , INAS) ,3*1 , INEAS) 

INI*  IF  (KFLAfi.EQ.  1)  THEN 

1191*  READ(3)((WATE(I,3),I*1,IH),3*1,INEAS) 

UN*  END  IF 

lllf*  ELSE 

1121*  INCAS-INAS 

1131*  CALL  COPYNT(AHAT,AMATE, INAS, INAS) 

1141*  CALL  COPYHT (BMAT,BMATE, INAS, IR) 

1151*  IF (KFLA6.E0. 1)  THEN 

1161*  CALL  COPYHT (HHAT , HHATE, IH, INAS) 


118f> 

END  IF 

119#* 

RENIND13) 

12##> 

CLOSE (3) 

121#* 

IF (KFLA6.E8.#)  PRINT*, 'CURRENT  STATUS: 

NO  KALMAN  FILTER’ 

1221* 

IF (KFLA6.E0. 1)  PRINT*,’ CURRENT  STATUS: 

KALMAN  FILTER  IN  LOOP’ 

123#* 

IF(NFLA6.EB.#)  PRINT*, 'EVALUATION  TRUTH  MODEL  *  DESIGN  MODEL’ 

124#* 

IF (NFLA6.EQ. 1)  PRINT*, ’ TRUTH  MODEL  IN  USE  FOR  EVALUATION’ 

125#*€ 

126#*C  THIS  SECTION  AU.ONS  CHANGES  TO  CURRENT  PROBLEM  MTA  TO  BE  HADE: 
127#*C  THE  RIDE  GETS  A  BIT  BUMPY,  SINCE  NE  N1LL  HAVE  TO  JUMP  AROUND 
128#*C  SORENHAT  TO  PICK  UP  ALL  OP  THE  APPROPRIATE  DATA  FOR  THE  PROBLEM 

129#*C 
13##*  3# 

PRINT*, ’ANY  CHAN6ES  TO  DATA?  Y/N:  ’ 

131#* 

READ!*,’ (A)’)ANSN 

132#* 

IFIANSN.NE. ’Y’.  AND.  ANSI.  NE.’N’)  60  TO  3# 

133#* 

IF(ANSN.EO.’N')  60  TO  28# 

134#* 

PRINT*, ’1*  EDIT  MATRICES 

5*  ENTER  ALL  NEM  DATA’ 

133#* 

PRINT*, ’2*  ADD/DELETE  EVAL  MODEL 

6*  NEH  DATA  FROM  TAPE’ 

136#* 

PRINT*, ’3*  ADD/DELETE  FILTER 

7*  NO  CHAN6ES’ 

137#* 

PRINT*, ‘4*  SAVE  DATA  TO  TAPE 

8*  El  IT  PROGRAM’ 

138#*  33 

PRINT*, ’ENTER  CHOICE:  ’ 

139#* 

READ*, 11 FLAG 

14##* 

IF( I 1FLA6. LT. l.OR. I1FLA8.6T. 8)  60  TO  35 

141#*  4# 

IF(I1FLA6.ES.1)THEN 

142#* 

PRINT*,’ 1-  A  (DESIGN) 

B*  KX’ 

143#* 

PRINT*, ’2*  A  (EVALUATION) 

9*  KZ’ 

144#* 

PRINT*, ’3*  TRANSFORMATION 

1#*  H  (DESIGN) ’ 

145#* 

PRINT*,’ 4*  B  (DESIGN) 

11=  H  (EVALUATION)' 

146#* 

PRINT*, ’3*  B  (EVALUATION) 

12*  KF6AIN’ 

147#* 

PRINT*, '6*  C 

13*  KIN’ 

148#* 

PRINT*, ’7*  DY 

14*  RETURN  TO  MENU' 

149#*  45 

PRINT*, ’ENTER  CHOICE:  ’ 

15##* 

READ*, I2FLA6 

151#* 

IF (I2FLA6. LT. l.OR. I2FLA6.ST. 14)  60  TO  43 

152#* 

1F(I2FLA6.E8.1)  CALL  EDIT ( AHAT, INDH, INDM, SCRACH) 

153#* 

IF ( I2FLA6. EB. 2)  THEN 

134#* 

IF (NFLA6.E0. 1) THEN 

155#* 

CALL  EDIT (AHATE,INEAS,INEAS, SCRACH) 

136#* 

ELSE 

157#* 

NFL AG* 1 

158#* 

60  TO  13# 

159#* 

END  IF 

16##* 

END  IF 

161#* 

IFU2FLA6.EB.3)  THEN 

162#* 

IF(NFLA6.EB.1)THEN 

163f* 

CALL  EDIT (TDTMAT,INAS,INEAS, SCRACH) 

164#* 

ELSE 

165#- 

NFLA6*1 

166#* 

60  TO  13# 

167#* 

END  IF 

168#* 

END  IF 

169#* 

IF(I2FLA6.EB.4)  CALL  EDIT (BHAT, INAS, IR, SCRACH) 

17##* 

IF ( I2FLAG.EB.S)  THEN 

171#*  IF  (NFLA6.EA.  DTHEN 


172#*  CALL  EDIT (MATE,  INCAS,  IR,SCRACH) 

173#-  ELSE 

174#>  NFLA6-1 

173#-  SO  TO  13# 

176#-  END  IF 

I77#>  END  IF 

178#*  IFII2FLA6.ES.6)  CALL  EDIT (CHAT, IP, INAS, SCRACH) 

179#-  IFU2FLA6.EQ.7)  CALL  EDIT tOVHAT, IP, IR, SCRACH) 

It##-  IF(I2FLAG.E0.B)  CALL  EDIT(KIHAT,IR,  INAS, SCRACH) 

181#-  IFU2FLA6.EB.9)  CALL  EDI  T(KZHAT,IR,  IP,  SCRACH) 

182#-  IF ( I2FLA6.6E. 18.  AM. I2FLA6.LE. 13) THEN 

183#-  IF (KFLA6. EB. f ) THEN 

184#-  KFLAG-1 

183#-  60  TO  24# 

18*8-  ELSE 

187#-  IF (I2FLA6.EQ. 18)  CALL  EDIT  I HHAT, IN, INDH, SCRACH) 

188#-  IF (I2FLAG.EB.il)  CALL  EDIT (HHATE, IH, INEAS, SCRACH) 

189#-  IF  < I2FLAS.E6. 12)  CALL  EDIT (KF6AIH, IHDH, IH, SCRACH) 

19##-  IFU2FLAG.Efi.13)  CALL  EDIT(KINHAT,IR,1NDIS, SCRACH) 

191#-  END  IF 

192f*  EM  IF 

193#-  IFU2FLA6.Efi.14)  60  TO  3# 

194#-  SO  TO  4# 

193#-  EM  IF 

196#-  IF  U1FLA6.EB.2)  THEN 

197#*  IF(NFLA6.Efi.l)  THEN 

198#-  NFLA6-# 

199#*  CALL  COPYHT(AHAT,AHATE,  WAS,  INAS) 

2###*  CALL  COPYNT  < MAT,  MATE,  INAS,  IR) 

2#1#-  IF (KFLA6.EB. 1 )  CALL  COPYHT (HHAT, HHATE, IN, INAS) 

2#2#»  INEAS— INAS 

2#3«-  PRINT*, ’EVALUATION  NODEL  DELETED’ 

2#4#*  ELSE 

2#3«-  NFLAG-1 

2ft#3  60  TO  13# 

2#7«-  END  IF 

2#8#»  END  IF 

2#9f-  IF(I1FLA6.EB.3)THEN 

21#f*  IF (KFLA6. EB. 1 ) THEN 

211#-  KFLA6-# 

212#-  PRINT*,’ KALHAN  FILTER  DELETED’ 

213#-  ELSE 

214#-  KFLAG-1 

213#-  SO  TO  24# 

2168*  EM  IF 

2178-  EM  IF 

218#-  IFU1FLA6.EQ.4)  60  TO  9# 

219#*  IFU1FLA6.EB.3)  60  TO  if# 

228#*  IFU1FLA6.E8.6)  60  TO  2# 

2218-  IF (I1FLA6.EB.7)  60  TO  288 

2228-  IF ( 11FLA6.ES. 8)  60  TO  999 

223#*  60  TO  38 

2248-C 

2238-C  SECTION  TO  SAVE  PROBLEM  DATA  TO  TAPE 


226#*C 

2278*  9#  PRINT*,’ ENTER  NAME  OF  FILE  FOR  DATA  SAVE:  ' 

228#*  READ!*, ’ (A) '(SAVE 

229#*  OPEN <2, FILE*SAVE, STATUS*’ NEN' , FORM*’ UNFORMATTED* ,ERR*9») 

23M*  HRITE(2)KFIAG,NFLAS,  INBN,  INDIS,  I  NAS,  IR,  IP 
2311*  MRITE<2)  ( (AHAT(If  J) ,  I*lf  INOH) ,  J*if  INIUf) 

2321*  WRITE (2) ( (BNATII, J) , 1*1, INAS) , J*l, IR) 

2331*  MUTE  (2) ( (CHAT (I, J) , 1*1, IP) , J«l , INAS) 

234#*  MUTE(2)dDYMATd,J),I*l,lP),J*l,IR) 

233#*  NRITE12) ( (KXNAT < I , J ) , 1*1 , IR) , J*1 , INAS) 

236#*  IIRITEI2>  ( IKZHATU,  J) ,  1*1,  IR) ,  J*l,  IP) 

2378*  IF(KFIA6.E0.1)THEN 

2388*  WRITE42) IH 

239#*  HRITE<2)  ( (HNATd,  J) ,  1*1,  IN) ,  J*l,  INON) 

24##*  MUTE  (2)  t  (KFBAINd ,  J) ,  1*1 ,  INON) ,  J*l,  IN) 

241#*  MUTE  (2)  ( 4KXNHAT  (I ,  J  > ,  1*1 ,  IR) ,  J*1 ,  INDIS) 

242#*  END  IF 

243#*  95  IF (NFLA6.EB. 1 ) THEM 

244#*  W8tITE(21  INCAS 

245#*  MUTEI2)  dAHATEd,  J), 1*1,  INEAS).  J*t, INEAS) 

246#*  MUTE  (2)  ( (BHATEd,  J),  1*1,  INEAS) ,  J*l,  IR) 

247#*  MUTE  (2)  ( (TDTNAT  d ,  J) ,  1*1,  INAS) ,  J*1 ,  INEAS) 

248#*  IF(KFLAG.EQ.I)  THEN 

2499*  MUTEl2)((HNATEd,J>,  1*1,  IH),  J*l,  INEAS) 

25##*  EMI  IF 

251#*  END  IF 

2528*  98  ENOF!LE<2> 

253#-  REMIND(2) 

254#*  CLOSE (2) 

255#*  SO  TO  3# 

256#*C 

2578*C  NORMAL  INPUTS  FROM  KEYBOARD 

258#*C  NOTE:  IN  DYNAMICS  MATRICES,  ENTER  DISTURBANCE  STATES  LAST 
259#-C 

26##*  18#  I1FLA6*# 

261#*  PRINT#, ’ IS  THERE  A  KALHAN  FILTER  IN  THE  LOOP?  Y/N:  ’ 

262#*  READ(#,’(A)’)ANSN 

263#*  IF(AN5N.NE.’Y’, AND. ANSN.NE.’N’ (THEN 

264#*  60  TO  IN 

265#*  aSE  IFtANSN.EB.’YMTHER 

2668*  KFLA8*1 

2678*  aSE 

2688*  KFLA6*# 

269#*  END  IF 

278#*  11#  PRINT*,  'HILL  THE  DESI6N  NODa  PLANT  BE  THE  ONE  USED  TO’ 

2718*  PRINT#, ’EVALUATE  THE  SYSTEM?  Y/N!  ’ 

2728*  READI#,’ (A)’)ANSH 

2738*  IF<ANSN.NE.’Y\AND.ANSN.NE.’N’)THEN 

2748*  SO  TO  118 

2758*  aSE  IF  (ANSN.EO.’N’)THEN 

2768*  NFLA6*1 

2778*  ELSE 

2788*  NFLA6*# 

2798*  END  IF 


28IN  PRINT  VENTER  NUMBER  OF  AUGMENTED  DESIGN  STATES:  ’ 

2811s  READ*, INDH 

282*>  PRINT*, 'ENTER  NUMBER  OF  DISTURBANCE  STATES  IN  DESIGN  MODEL 

283*«  READ«,INOIS 

284««  INAS<INDH-INDIS 

283*«  PRINT*,' ENTER  NUMBER  OF  CONTROLS:  ’ 

28A*>  R£AO*,IR 

287*>  12*  IF(KFLA6.E0.1.0R.NFLAG.E0.f)THEN 

288*>  PRINT*, 'ENTER  AUGMENTED  DESIGN  DYNAMICS  MATRIX:  ' 

289*>  CALL  CREA8 ( AMAT, INDH, INDH, SCRACH) 

29#*»  PRINT*, 'ENTER  DESIGN  CONTROL  MATRIX:  ' 

291**  CAU.  CREAD(BMAT,INAS,IR, SCRACH) 

292*«  1F(NFLA6.EB.*)THEN 

2931*  CALL  COPYHT (AMAT, ANATE, INAS, I NAS) 

294*>  CALL  COPYHT <BMAT,BMATE,  IMS,  IR) 

295*«  INEAS*INAS 

296*>  END  IF 

297*>  END  IF 

298*>  13*  IF  (NFLAG.EB.l)THEN 

299*«  PRINT*, 'ENTER  NUMER  OF  SYSTEM  STATES  IN  EVALUATION’ 

3t**>  PRINT*, 'DYNAMICS  MATRIX:  ’ 

3*1**  READ*,  INCAS 

3*2*>  PRINT*, 'ENTER  EVALUATION  DYNAMICS  MATRIX:  ' 

3*3*»  CALL  CREAD (ANATE, INEAS, INEAS, SCRACH) 

3*4*3  PRINT*, 'ENTER  EVALUATION  CONTROL  MATRIX:  ' 

3*5*3  CALL  CREAD (BNATE, INEAS, IR, SCRACH) 

3*60«  14*  PRINT*, ’ENTER  TRANSFORMATION  MATRIX-EVALUATION  TO’ 

3*7**  PRINT*, ’DESIGN  HOOEl  DIMENSIONS  (SYSTEM  STATES  ONLY):  ’ 

3*8*«  CAU  CREAD(TDTHAT, INAS, INEAS, SCRACH) 

3*9*>  END  IF 

310*«  IF (I1FLAG.EB.2.ANB.KFLA6.EB. 1)  60  TO  25* 

3U*>  80  TO  (4*,  3*)  UFLAG 

312*«  i5f  PRINT*, ’ENTER  NUMBER  OF  OUTPUTS:  ’ 

313**  READ*, IP 

3140*  PRINT*, 'ENTER  OUTPUT  MATRIX:  ’ 

315*«  CALL  CREAD(CHAT, IP, INAS, SCRACH) 

316*-  itf  PRINT*, 'IS  THERE  DIRECT  INPUT  FEEDTHR0U6H  ?  Y/N:  ’ 

317*3  READ(»,’(A)’)ANSN 

318*>  IF(ANSN.NE.’Y’.AND.ANSN.NE.'N')  THEN 

319*3  60  TO  16* 

32**-  USE  IF  (ANSN.EB.’Y’)THEN 

321f«  PRINT*, ’ENTER  FEED  THROWN  MATRIX;  ’ 

322f>  CALL  CREAD (DYNAT, IP, IR, SCRACH) 

323f«  ELSE 

324*>  DO  2ff  I-l.IP 

325**  DO  2**  J«1,IR 

3260*  DYMAT ( I , J ) *CNPLX (*.*,*.*) 

3270*  2 (*  CONTINUE 

328*«  END  IF 

329*«  22*  PRINT*, 'ENTER  KX  MATRIX:  ’ 

33**3  CALL  CREAD (KXHAT,IR, INAS, SCRACH) 

331**  23*  PRINT*, ’ENTER  KZ  MATRIX:  ’ 

?32*«  CALL  CREAD(KZNAT,IR, IP, SCRACH) 


334#*C  DATA  THAT  FOU.OHS  IS  NOT  NEEDED  IF  THE  KALMAN  FILTER  IS  NOT  PRESENT 
335#*C 

336#*  24#  IFIKFLAS.NE.l)  60  TO  3# 

337#*  PRINT*,’ ENTER  NUMBER  OF  HEASURENENTS:  ’ 

338#*  READ*, IN 

3391*  PRINT*, 'ENTER  H  MATRIX  FOR  DESIGN  MODEL:  ’ 

34##*  CALL  CREAD (HHAT, IN, INDM, SCRACH) 

341#*  PRINT*, ’ENTER  KALMAN  FILTER  SAINS:  ’ 

342#*  CALL  CREAD (KF6AIN, INDM, IN, SCRACH) 

343#*  PRINT*, 'ENTER  KXN  MATRIX:  ’ 

344#*  CALL  CREADfKXNHAT,IR,INDIS, SCRACH! 

343#*  23#  IFlNFLA6.Efi.il  THEN 

346#*  PRINT*, ’ENTER  H  MATRIX  FOR  EVALUATION  MODEL:  ’ 

347#*  CALL  CREAD 1HMATE, IM, INEAS, SCRACH) 

348#*  END  IF 

349#*  60  TO  (4#, 3#, 3#)  I1FLA6 

33##*  60  TO  3# 

33l#*C 

352#*C***** ************** ************************************************** 
333#*C 

354#*C  END  OF  INPUT  SECTIM 

333#*C  NON  BE6IN  TO  CALCULATE  SINGULAR  VALUES 

336#=C 

3578-C********************************* *********************** ************* 
358#=C 

339#=  28#  PRINT*, ’ENTER  SAHPLIN6  TIME  INTERVAL:  ' 

36##*  READ*,TSAMP 

361#*  PRINT*, 'ENTER  STARTING  FREBUENCY  (RADIANS)  AS  A  PONER  OF  1#:  ’ 

362#*  READ*, INST 

363#-  NRAD=1#.#**INST 

364#*  NRAD*NRAD*.f#######l»AfiS(HRAD> 

363#-  DO  3##  1*1,16 

366#*  DO  29#  J*l,16 

367#*  ZIDENT(I,J)*CMPLX (#.#,#.#) 

368#*  29#  CONTINUE 

369#-  ZIDENT(I,I)*CMPLX(1. #,#.#) 

37##*  3##  CONTINUE 
371#*  INFLAG*# 

372#*C 

373#*C  USER  HAY  SPECIFY  SIN6ULAR  VALUE  ANALYSIS  OF  THE  LOOP  MATRIX  OR  THE 
374#*C  INVERSE  RETURN  DIFFERENCE  MATRIX,  NITH  THE  LOOP  CUT  AT  THE  INPUT 
373#*C  OR  THE  OUTPUT. 

376#*C 

377#*  33#  PRINT*, ’1*  SINGULAR  VALUES  OF  LOOP  MATRIX’ 

378#*  PRINT*, ’2*  SINGULAR  VALUES  OF  INVERSE  RETURN  DIFFERENCE  MATRIX’ 
379#*  PRINT*, ’ENTER  CHOICE  <:  ' 

38##*  READ*, JFLA6 

381#*  IF  (JFLA6.LT. 1. OR. JFLA6.6T. 2)  60  TO  338 
382#*  33#  PRINT*, ’1*  LOOP  CUT  AT  CONTROL  INPUT’ 

383#*  PRINT*, ’2*  LOOP  CUT  AT  PLANT  OUTPUT’ 

384#*  PRINT*, ’ENTER  CHOICE  •:  ’ 

383#*  R£AD»,LFLA6 

386#*  IF  1 LFLA6.LT. 1.0R.LFLA6.6T. 21  60  TO  35# 

387#*  IF  (KFLA6.EB.il  60  TO  6N 


•  .  *  .  *  «  "  •  *  m  *  »  •  » 

.  *  *  •  -  *  to* 
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388#*C 


39M«C 

391*«C  BRANCH  TO  CALCULATE  SIN6ULAR  VALUES  WITH  NO  FILTER 
392K 

394#*C 

393#*  4M  DO  3M  1*1,37 
39M*C 

397#*C  CONTROLLER  CALCULATIONS 
398#*C 

399#*  Z*£XP(CNPLX (i.i,TSAHP*NRAD) ) 

4W*  ZLESS’Z-l.l 

4#i«*  CALL  CSMUL4ZLESS, ZIDENT, BttORK, IR, IR) 

4#2t*  CALL  CHATNL (KZNAT, DYIIAT, ANORK,  IR,  IP,  IR) 

4131*  CALL  CHATAO  4  AMOftK, BHOftK, CNORK, IR, IR> 

4#4#*  CALL  CNATIN(CN0RK,CN0RK,IR,DN0RK,HFLA6) 

415#=  IF  (NFLA6.NE.DTHEN 

4#6f*  PRINT*,’ PROBLEM  IS  IN  CONTROL  LAN  CALCULATION’ 

4f7M  PRINT*, ’H  *  *,NRAD 

4#8#»  MFLAW 

4*9#»  60  TO  31 

41##*  END  IF 

411f>  42#  ZLESS— ZLESS 

4121s  CALL  CSNUL(ZLESS,KXNAT,ANORK,IR,INAS) 

4131s  CALL  OIATML(KZMAT,CIIAT,BNORK,IR,IP,INAS) 

4141s  CALL  CMATSB<AHQRK,BNORK,ANORK,IR,INAS) 

415i=  CALL  CMATNL{CN0RX,AH0RX,BN0RK,1R,IR,INAS) 

4161s  CALL  COPYNT <BNORK,CNORK, IR, INAS) 


417f»C 

418#»C  PLANT  CALCULATIONS  AND  CONVERSION  TO  DESI6N  MODEL  STATE  DIMENSION 
419W 

42M>  Z0HS<1.  f-EXP  (CHPLX  <#.  f ,  -TSA»*NRAD> ) )  /CHPLX  (I.  I,  HRAD) 

4211s  SsCMPLX(f.f,NRAD) 

4221s  CALL  CSNUL(S,ZIDENT, ANORK, INEAS, INEAS) 

4231s  CALL  CHATSBIANORK, ANATE, ANORK, INEAS, INEAS) 

4241s  CALL  CMATINIANORK, ANORK, INEAS, DNORK.HFLAS) 

4231s  IF  (NFLAS.NE.f)  THEN 

42 PRINT*, 'PROBLEM  IS  IN  PLANT  MATRIX’ 

4271s  PRINT*, ’N  »  ’,NRAD 

4281s  NFLAG*# 

429#«  SO  TO  31 

43M>  END  IF 

4311s  44#  IF  UNEAS.NE.INASITHEN 

4321*  CALL  CNATNL(ANORK,BNATE,BNORK, INEAS, INEAS, IR) 

4331s  CALL  CHATNL ITDTHAT.BNORK, ANORK, INAS, INEAS, IR) 

4341s  ELSE 

433**  CALL  CNATHLIANORK, BHAT,BNORK, INAS, INAS, IR) 

4361s  CALL  COPTHT (BNORK, ANORK, INAS, IR) 

4371*  END  IF 

4381s  CALL  CSHUUZOH, ANORK, ANORK, INAS, IR) 

439*«C 

44#f»C  CUT  THE  LOOP  AND  FORM  THE  FUNCTION  TO  BE  PLOTTED 


442**  1F(LFLAG.E0.1)THEN 

4431*  CALL  CMATHLtCWMK,  MMMK.BHORK,  IRt  INAS,  IR) 

4441*  CALL  CMTIN(BNORK,CNORK,  IR,  DNORK,  NFLA6) 

443**  IF  (HFLA6.NE.*)THEN 

446#*  PRINT*, ’PROBLEM  IN  LOW  MATRIX* 

447**  PRINT*, 'N  ■  ',MRAD 

448**  HFLA6*# 

449**  60  TO  3* 

43M*  EM  IF 

431**  46*  CALL  01ATAD<CMRK,ZIDENT, ANORK, IR,1R) 

432**  IF  ( JFLA6. EQ. 2) THEN 

433**  CALL  CSVOG (AMORK,  16,  IR,  IR,SV,E,U,  16, V,  16,  HOftK,  #,  INFO) 

434**  aSE 

435**  CALL  CSVDC(BNORK,  16,  IR, IR,SV,E,U,  16, V,  16, HORN,*,  WO) 

4361*  END  IF 

437*-  RESULT < I, 1)*NRAD 

438**  R£SULT(I,2)*L061*(CA8S(SV(INF0+l))) 

4399*  IF(1NF0.6T.INFLA6)  INFLA6*INF0 

46#**  R£SULT(I,3)«L061*(CABS(SV(IR>>) 

461**  ELSE 

462**  CALL  CMTHl(ANORK,CNORK,BNORK,INAS,  IR,INAS) 

463**  CALL  COPYNT(BNORK,DNORK, INAS, INAS) 

4649*  CALL  CSVK(M0m,16,INAS,INAS,SV,E,U,16,V,16,H0RK,22,INF0) 

463**  CALL  C1P0SE(U,AMRK,INAS,IR) 

4669*  DO  479  J*1,1K 

4679*  DO  463  K*1,IR 

4689*  CNORK(J,K)*CMPlX (#•#,#.#) 

4699*  463  CONTINUE 

47*9*  CMRKM,J)*SV<J) 

471*-  47*  CONTINUE 

4729*  CALL  CMTN(CNORK,CNORK,  IR, DNORK, HFLA6) 

4739*  IFIHFLA6.NE.*)  THEN 

4749*  PRINT*,’PROBLEH  IS  IN  PSEUDOINVERSE’ 

4739*  PRINT*, ’N  «  ’,HRAD 

476#*  MFLA6** 

477**  60  TO  3* 

478**  EM  IF 

479**  CALL  CIMTHL  (CNORX, ANORK , DNORK, IR, IR, INAS) 

48#**  CALL  CHATNL(V, DNORK, CNORK,  INAS,  IR,  INAS) 

481«*  48*  CALL  CHATAD(CMRK,ZIDENT, ANORK,  INAS, INAS) 

482**  IF ( JFLAG. EB. 2) THEN 

483**  CALL  CSVDC(AN0RK,16, INAS, INAS, SV,E,U, 16, V, 16, NQRK,*, INFO) 

484**  aSE 

483**  CALL  CSVDC(BN0RK,16, INAS, INAS.SV,E,U,16,V,16,NORK,#,INFO) 

486**  EM  IF 

487**  RESULT! I, 1)*NRAD 

488**  RESULT ( I , 2) *L061f (CABS ( SV ( INFO* 1 ) ) I 

489f*  IF ( INFO. GT. INFLA6)  INFLAS-INFO 

499**  RESULT ( I , 3) *L06I« (CABS ( SV ( IR) ) ) 

491**  END  IF 

492#*C 

493**C  INCREMENT  FREQUENCY  AND  REPEAT  SINGULAR  VALUE  CALCULATION 
494#*C 

493**  DELN*INT((L06(NRAD) ) /L06(l#.») ) 


4961*  NINC*<EHMLQ6(l#.#)»DELN>)*l#.#/2#.# 

4971*  IF(HRAD.SE.1.#)HRAD*HRAD+N1NC 

498#*  IFOMAD.LT.  l.#)HRAO*NRAD+NINC/l#. 

499#*  SM  CONTI  (WE 
50##*  60  TO  9«# 

5#1#*C 

5#3#*C 

S#4#*C  BRANCH  TO  CALCULATE  SINGULAR  VALUES  MITH  KALHAN  FILTER 
3#3#*C 


5#7#*C 

5#8#*C 

S#9#*C  CONTROLLER  CALCINATIONS 
S1«#*C 

511#*  6##  CALL  CDSCRT  ( AHAT ,  INDN,  TSANP,  PH  I  DSC,  BDSC,  3#, ANORK, BNORK,  CHORK) 
312#*  CAU  CHATIN(PH!DSC,PM!DSC,INDH,DNORK,HFLAG) 

313#*  IF (HFLAS. NE.#) THEN 

314#*  PRINT*,' PROBLEM  IS  IN  TRANSITION  MATRIX' 

313#*  HFLAS*# 

316#*  60  TO  3# 

317#*  END  IF 

318#*  6#5  CAU  CHATHL(BOSC,BHAT, ANORK, INDN,  I  NAS,  1R) 

319#*  CAU  COPYNT  ( ANORK,  BDSC,  INDN,  IR) 

52##*  61#  DO  7#f  1*1,37 

521C*  Z=£XP  (CHPt.X  (#.#,  TSAHP*HRAD) ) 

522#*  CALL  CNATNL(KZHAT,CNAT,ANQRK,IR,IP,INAS) 

323#*  ZL£SS*1.#-Z 

524#*  CALL  CSNUL(ZLESS,KXNAT, BNORK, IR,INAS) 

323#*  CAU  CNATSBtBMRK,  ANORK,  ANORK,  IR,  IMS) 

526#*  ZLESS*-ZLESS 

327#*  CAU  CSNUL<ZLESS,KXNMT,BNORK,IR,INDIS) 

328#*  DO  6 21  4*1, IR 

329#*  DO  613  K*1,INAS 

53##*  CNORK(J,K)*ANORK(J,K) 

331#*  615  CONTINUE 

332#*  DO  62#  K*INAS+1,1NDN 

533#*  CH0RK(J,K)*BN0RK(4,K-INAS( 

334#*  62#  CONTINUE 

333#*  CAU  CSNULULESS, ZIDENT, ANORK, IR,IR) 

536#*  CALL  CNATNL (KZHAT,DYHAT, BNORK, IR, IP, IR) 

337#*  CALL  CNATADtANORK, BNORK, ANORK, IR,IR> 

338#*  CALL  CNATIN(ANORK, BNORK, IR,DNORK, HFLAS) 

339#*  IF (HFLAS. NE.#> THEN 

34##*  PRINT*, 'PROBLEM  IS  IN  CONTROL  LAN  CALCULATIONS’ 

341#*  PRINT*, ’N  *  *  VNRAD 

542#*  HFLAS*# 

543#*  SO  TO  3# 

544#*  END  IF 

545#*  625  CALL  CMTNL(BNORK, CHORK, ANORK, IR,IR, INDN) 

546#*  CALL  COPYNT (ANORK, CNORK,IR, INDN) 

347#*  CALL  CMATML4B0SC, CHORK, ANORK, INDN, IR, 1NDH> 

548#*  CALL  CHATIKPHIDSC, ANORK, BNORK,  INDN,  INDN,  INDN) 

549#*  CALL  CNATNL (KFBAIN,HNAT, ANORK, INDN, IN, INDN) 
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3504*  CALL  CRATSBtANORK, ZIOENT, ANORK, INOtf,  INDH) 

5514*  CALL  CRATS8(ANQRK,BN0RK,BN0RK, INDH, INDR) 

5524*  CALL  CSIHIL<ZfPtUOSCfAMlRKyINDnf  INOtl) 

5534*  CALL  CHATA0IAN0RK,8N0RK, BNORK, INDR, INDH) 

5544*  CALL  ClMTIN<BWMKtBHORKl  IN0Mf  0t«0RK,HFLA6> 

5554*  IF  (HFLA6.NE.4)  H£N 

5544*  PRINT*, 'PROBLEM  IN  CONTROL  LAN  CALCULATION’ 

5574*  PRINT*,’N  *  ’,NRAO 

5584*  NFLA6*4 

5594*  60  TO  34 

5444*  END  IF 

5414*  434  CALL  CRATNL (CNORK, BNORK,  ANORK,  IR,  IRON,  INDR) 

5424*  CALL  CRATNL (ANORK, KF6AIN, BNORK, IR, INDH, IR) 

5434*  CALL  CRATHL(BNORK,HHATE,ANORK,IR,IH,INEAS> 

5444*  ZOH* ( 1 .4-EIP (CHPLX (4.4, -TSAHP«NRAD) ) ) /CDPLI <4.4, HRAO) 

5454*  CALL  CSHULUOH, ANORK, ANORK, IR, INDH) 

5444*C 

5474*C  PLANT  CALCULATIONS 

NAflfxT 

5494* 

5744* 

5714* 

5724* 

5734- 
5744* 

5754* 

5744= 

5774* 

5784* 

5794- 
5844* 

S814-C 

5824-C  CUT  THE  LOOP  AND  F08H  THE  FUNCTION  TO  BE  PLOTTED 
5834-C 

5844*  IF (LFLA6.EB. I>  THEN 

5854*  CALL  CRATNL(ANORK, BNORK, CNORK, IR, INEAS, IR) 

5644*  CALL  CHATIN(CNORK, ANORK, IR, BNORK, RFLA6) 

5874*  IF(HFLA6.NE.4)THEN 

5884*  PRINT#, 'PROBLEM  IN  LOOP  FUNCTION  INVERSION’ 

5894*  PRINT*, ’N  *  ’,NRAO 

5944*  NFLA6-4 

5914*  60  TO  34 

5924*  END  IF 

5934*  CALL  CRATAD (ANORK, Z I DENT, BNORK, IR,IR) 

5944*  644  IF ( JFLA6. EQ.2)  THEN 

5954*  CALL  CSVDC(BN0RK,16,IR,IR,SV,E,U,16,V,16,N0RK,4,INF0> 

5964*  ELSE 

5974*  CALL  CSVDC(CN0RK,16,IR,IR,SV,E,U,16,V,16,N0RK,4,INF0) 

5984*  END  IF 

5994*  RESULT ( I, 1)*NRAD 

6444*  RESULT! I,2)*L0614(CABS(SV(INFQ*1))) 

6414*  IF ( INFO. 6T . INFLA6)  INFLA6-INF0 

6424*  RESULT (I, 3)*L0614(CABS(SV( IR) )) 

6434*  ELSE 


S*CHPLX(4.4,NRAD) 

CALL  CSRUL(S,ZIDENT, BNORK, INEAS, INEAS) 

CALL  CRATSBtBNORK, ABATE, BNORK, INEAS, INEAS) 
CALL  CHATINtBNORK, BNORK, INEAS, 0N0RK,NFLA6) 
IF(RFLA6.NE.4)THEN 

PRINT*,’ PROBLER  IN  PLANT  CALCULATION’ 
PRINT*, ’N  *  ’,NRAD 
HFLA6*4 
60  TO  34 
END  IF 

CALL  CRATNL ( BNORK, BHATE, CNORK, INEAS, INEAS, IR) 
CALL  COPYHT(CNORK, BNORK, INEAS, IR) 


4141*  CALL  CfMTNLfMORX, AM0RK,CI40RKf  INEAS,  IRf  INEAS) 

4151*  CALL  COPYHT<CHORK,DNORK, INEAS, INEAS) 

4444*  CALL  CSVDC (DMRK, 14, INEAS, INEAS, SV,E,U, 14, V, 14, HORK, 22, INFO) 

4171*  CALL  CXPOSE ( U, ANORK, INEAS, IR ) 

4184*  DO  444  J=1,IR 

4494*  DO  4S4  K*1,IR 

4144*  BN0RK(J,K)*CHPLX(4.4,4.4) 

4114*  454  CONTINUE 

4124*  BNORK(J,J)*SVIJ) 

4134*  444  CONTINUE 

4144*  CALL  d9ATIN{B440RKlM0RKf  IRyDH0RKy(tfLA6) 

4154*  IFIHFLA6.NE.4)  THEN 

4144*  PRINT*, ’PROBLEM  IS  IN  PSEUDOINVERSE’ 

4174*  PRINT*, ’N  *’, WAD 

4184*  HFLA6*4 

4194*  80  TO  34 

4244*  END  IF 

4214*  CALL  CMATNLIBNORK, AHORK,DHORK, IR, IR, INEAS) 

4224*  CALL  CMATNL (V, DHORK, BHORK, INEAS, IR, INEAS) 

4234*  484  CALL  CHAT  AO  <8N0RI(,Z  I  DENT,  ANORK, INEAS, INEAS) 

4244*  IF (JFLA6. Efl.21  THEN 

4254*  CALL  CSVDC (AMORK, 16, INEAS, INEAS, SV, E, U, 14, 

4244=  1  V, 14, HORN, 4, INFO) 

4274*  ELSE 

4284*  CALL  CSVDC (CMORK,  14, INEAS, INEAS, SV.E,U,  14, 

4294*  1  V,  14,  NORM,  INFO) 

4344*  END  IF 

4314*  RESULT ( I, 1)*NRA0 

4324*  RESULT(I,2)*L0B14<CABS(SV(INF0*1)» 

4334*  IFIINF0.6T. INFLA6)  INFLA6*INF0 

4344*  RESULT ( I , 3) sLOSl f (CABS (SV ( IR) ) ) 

4354*  END  IF 

4344*C 

4374*C  INCREMENT  FREQUENCY  AND  REPEAT  SINGULAR  VALUE  CALCULATION 
4384*C 

4394*  DELN«INT  ( (LOG  (WAD) )  /LOG  ( 14. 4) ) 

4444*  NINC* (EXP (L06 (14.4) »DELN) ) *14. 4/24. 4 

4414*  IF(WAB.6E.1.4)  WAD=WAD+NINC 

4424*  IF(WAD.LT.1.4)  NRAD*WAD*NINC/14.4 

4434*  744  CONTINUE 
4444*C 

4454«C***********************»******************«************************** 

4444*C 

4474*C  SET  UP  RESULTS  AND  CALL  LINE  PLOTTER 
448#*C 

4494*C*******************»***************************** ******************** 
45»4*C 

4514*  944  CALL  SETPLT(RESULT,37,3,PLTVEC) 

4524*  PRINT*,’* - ENTER  TITLE  FOR  PLOT - ♦’ 

4534*  PRINT* 

4544*  READ!*,’ (A)’ITITLE 

4554*  PRINT*, ’1  *  SIN6LE  PLOT,  SIN6LE  SCALE’ 

4544*  PRINT*, ’2  *  TNO  PLOTS  --  ONE  SIN6LE  SCALE,  ONE  DOUBLE  SCALE’ 

4574*  PRINT*, ’3  *  SINGLE  PLOT,  DOUBLE  SCALE’ 


K  \ 


4581*  91#  PRINT*, 'SPECIFY  TYPE  OF  PLOT:  ’ 

459#*  READ*, IPSC 
44##*  IPSC*IPSC-2 

441#=  1FIIPSC.6T. 1.0R.IPSC.LT.-1)  60  TO  91# 

442#*  CALL  PLOTLP (PLTVEC, 37,2, IPSC, 1 ,(, TITLE) 

443#*C 

664#=C********tt****4*t4**it«**t4**tttt**mt***mf***t**»tmttt*mtmt 

445#*C 

444#*C  REPEAT  PROGRAM  UNTIL  USER  TERMINATION 
447#*C 

668#=C****«****t**4t4t*t***t*»tt***t»*ft»mt**tt**t<**ft»«*»m<»*t***m*t* 

449I=C 

47##*  IF ( INFLAG. NE. f )  PRINT*,’ POSSIBLE  ERRORS. .. INFO  FLA6  *  ’ , INFLAG 

4711*  998  60  TO  3# 

672#*  999  ENDFILE(4) 

673#*  REMIND (4) 

674#*  CLOSE (4) 

675#=C 

676#=C  END  OF  MAIN  PR06RAH  C6TSVD - 

677#*C 

678#*  END 

6790*C 


'a* 

v.* 


4S>l<C*H»t***««ft*Htt«tt<i«»tHt*t*t*HHHHHHHHHHHHHHHI»Ht 

681f=C»*******t**«t**»»«**»*tt»tt*****»****tt*t*«t»«*«*m»**»«t**«t*«»*»*t 

682#*C 

683#*  SUBROUTINE  CREAD(A,L,H,AA) 


\m 

684#=C 

m 

685#=C<***M«<**<»*»**»»»*t*4»*»*»t*«*t*t»«**t»*t«***m*«***««<tt**t*t*«* 

686#*C 

I'.V 

687#*C  THIS  ROUTINE  MILL  PROMPT  THE  USER  TO  INPUT  AN  L  BY  N  REAL  MATRIX 

688#=C  FROM  THE  KEYBOARD.  THE  MATRIX  IS  THEM  CHAN6ED  TO  TYPE  COMPLEX,  AND 

689#*C  RETURNED  AS  A.  AA  IS  A  DUMMY  REAL  ARRAY. 

69##=C 

691#=C»*4****»«»*»»»*»t**t**t**»****t*tt*m***t***t**tt**tt**«i***»«*t»ttt 

692#*C 

693#* 

COMPLEX  A<16,*> 

be 

694#* 

REAL  AA(N) 

m 

695#= 

INTEGER  I, J,L,H 

696#* 

PRINT’!'  ',12, IX, 'BY', IX, 12)’, L,M 

. 

697#= 

00  1M  1*1, L 

698#* 

PRINT*, ’ENTER  R0N’,I,’:  ’ 

699#* 

READ* ,(AA(J),J*1,M) 

b? 

7###* 

DO  19#  J*1,M 

7#1#> 

A(I,J)*CHPLXIAA(J),#.#) 

7#2f*  If# 

CONTINUE 

1  ‘  j 

7(3#* 

END 

7#4(*C 

y- 

7#5#*C  END  SUBROUTINE  CREAD  - 

706(*C 

7#7#*C 

708#* 

SUBROUTINE  CHATIN(AA,B,M,A,MFLA6) 

. 

7#9#«C 

JSfl 

7i#f*C*************»***»tt*t*m****«t»***m***t*tt**»»+t*tt«mm***tt*t 

■> 

7U#*C 

S\-. 

o- 
iv : 

B-31 

13 

r-.v 

mmmm 

*V  - 

j- 

712#*C  THIS  ROUTINE  HILL  FIND  THE  INVERSE  OF  A  COHPLEX  SQUARE  MATRIX  OF 
713I*C  OF  DIMENSION  M. 

714#*C  AA*INPUT  MATRIX,  RETURNED  UNHARMED 
715#*C  B*  OUTPUT  MATRIX 
71AM  A>  A  DUMMY  ARRAY 

717#*C  NFLA6*SET  TO  1  IF  MATRIX  IS  ALSQRITHMICALLY  SIN6ULAR 
718#*C 

72 AM 

721#=  COHPLEX  f  THAT 

722#*  INTE6ER  I,J,K,L,H,HAXP,HFLA6 

723#*  HFLAS*# 

724#*  DO  5#  1*1, H 

725#*  DO  4#  J*1,H 

726#*  A(I,J)*AA(I,J) 

727#*  B(I,J)*CHPLXI#.#,#.#) 

728#*  4#  CONTINUE 

729#*  B(I,1)*CHPLX(1. #,#.#) 

730#*  50  CONTINUE 

731#*  DO  6##  J*1,H 

732#*  HAXP*J 

733#*  DO  2##  I*J,H 

734#*  IF(CABS(A<I,J)).8T.CABS(A(HAXP,J)))  THEN 

735#*  HAXP*I 

736#*  END  IF 

737#*  2##  CONTINUE 

7380*  IF(CABS(A(MAXP,J)).LT.l. IE-12) THEN 

7390*  PRINT*, 'SINGULAR  MATRIX  IN  CRATIN’ 

740#*  MFLA6*1 

741#*  RETURN 

742#*  ELSE 

743#*  DO  3#«  L*1,H 

744#*  THAT*A(J,L) 

745#*  A(J,L)*A(HAXP,L> 

746#*  AIMAXP,L)*TNAT 

747#*  THAT*B<J,L> 

748#*  B(J,L)*B(NAXP,U 

749#*  B(MAXP,L)*TMAT 

75##*  3##  CONTINUE 

751#*  THAT*A(J,J) 

752#*  DO  4##  L*1,M 

753#*  A<J,L)*A(J,L)/THAT 

754#*  BU,L)*BU,L)/THAT 

755#*  4##  CONTINUE 

756#*  DO  55#  L*1,H 

757#*  IF  (J-U  45#,  550, 45# 

758#*  45#  TNAT*A(L,J) 

759#*  DO  5##  K*1,H 

76##*  A(L,K)*A(L,K)-A(J,K)»TNAT 

761#*  B(L,K>«B<L,K)-BU,K)#THAT 

762#*  5##  CONTINUE 

7631*  55#  CONTINUE 

764#*  END  IF 

765#-  60#  CONTINUE 


7461=  END 

7&7i*C 

76S0=C  END  SUBROUTINE  CHAT IN  - 

7690=C 

7700*C 

7711=  SUBROUTINE  CHATNL(A,8,C,L,H,N) 

7720*C 

7740*C 

775#»C  THIS  ROUTINE  HILL  HULTIPLY  TW  COMPLEX  MATRICES 

776I=C  A=AN  L  BY  N  COMPLEX  MATRIX 

777f=C  B=AN  N  BY  N  COMPLEX  MATRIX 

7780=C  C=THE  L  BY  N  COMPLEX  PRODUCT  OF  A  AND  B 

779«=C  NOTE'.  ACTUAL  ARGUMENT  C  MUST  DIFFER  FROM  A  AND  B 

7800*C 

782«=C 

7831=  COMPLEX  AI16,i),BU6,»),CU6,*) 

7841=  INTEGER  I,J,K,L,HfN 

7830=  DO  1M  1*1,  L 
7860=  DO  1M  J*1,N 

7870*  C(I,J)*CHPLI 10.0,0.0) 

7880*  100  CONTINUE 

7890=  DO  200  1=1, L 

7900*  DO  200  3*1, N 

7910=  DO  200  K*1,N 

7920=  C(I,J)*C(I,J)+A(I,K)*D(K,J) 

7930=  200  CONTINUE 
7940=  END 
7950*C 

7960*C  END  SUBROUTINE  CNATNL  - 

7970«C 

7980=C 

7990*  SUBROUTINE  CHATAD(A,B,C,L,N) 

MMsf 

Of *»w 

8010*CM4HMHHHffffffHfMMMHCtifHf(HMMtMffMHHMH#f#fMfHf 

8020*C 

8030*C  THIS  ROUTINE  ADOS  TNO  COMPLEX  HATRICES  OF  DIMENSION  L  BY  H 

8040*C  A  AND  B  ME  THE  INPUTS,  C  IS  THE  SUN 

8030*C 

8040*C>HtiHHH<«HHHHIHHHIHHIHiHIHIHHtlHIIHH<HI>MHH 

8070*C 

8080*  COMPLEX  A(16,*),B(16,»),C(16,») 

8090*  INTEGER  I,J,L,H 

8100*  DO  1M  1*1,  L 

8110*  DO  100  J*1,H 

8120*  C(I,J)*A(I,J)+B(I,J) 

8130*  100  CONTINUE 
8140*  END 

8150*C 

8160*C  END  SUBROUTINE  CHATAD  - 

8170*C 

8180*C 

8190*  SUBROUTINE  CHATSB(A,8,C,L,H) 


8288*C 

SZlKHHHIHHHHiWHHHHHHtHHHWHHIHIHHHHiHHHIHH 

B22f*C 

8238*C  THIS  ROUTINE  SUBTRACTS  COMPLEX  MATRIX  B  FROM  COMPLEX  MATRIX  A 
B248=C  DIFFERENCE  IS  RETURNED  IN  COMPLEX  MATRIX  C. 

825#=C  ALL  THREE  MATRICES  ARE  OF  DIHENSION  L  BY  N 
8268*C 

82B8*C 

82?#*  COMPLEX  A(16,»>,8<16,»),C(i6,#> 

8388*  INTE6ER  I,J,L,H 

8311*  DO  IM  1=1, L 

832#=  DO  If*  J=1,H 

8331*  C(I,J)*A(I,J)-B(I,J) 

8341=  1M  CONTINUE 
8338=  END 

8368*C 

8378=C  END  SUBROUTINE  CNATSB  - 

8388=C 

839#=C 

8488=  SUBROUTINE  CSHUL(A,B,C,L,H) 

8418=C 

843f=C 

8448=C  THIS  ROUTINE  MULTIPLIES  A  COMPLEX  MATRIX  BY  A  COMPLEX  SCALAR 

8458*C  A=  THE  COHPLEX  SCALAR 

8468=C  B=  THE  COHPLEX  MATRIX 

8478=C  C«  THE  COHPLEX  PRODUCT 

8488*C  B  AND  C  ARE  OF  DIMENSION  L  BY  H 

849#=C 

8318=C 

8328=  COHPLEX  A,BU6,»),C<16,«) 

8338=  INTEGER  I,J,L,H 

8348=  DO  188  1*1, L 

8338=  DO  188  J*1,H 

8368*  C(I, J)=A*B(I,J) 

8378=  188  CONTINUE 
8388=  END 

8398*C 

8688=C  END  SUBROUTINE  CSHUL  - 

861 8=C 
8628»C 

8638*  SUBROUTINE  COPYHT(A,B,N,H) 

8648*C 

8658=C»**»**«**«»*H»*«#*fM«***«M*tM*******4*»»f*»*»***Mt#»**#**»Mtt 

8668*C 

8678*C  THIS  ROUTINE  COPIES  COHPLEX  MATRIX  A  INTO  COHPLEX  HATRIX  B. 

8688*C  BOTH  MATRICES  ARE  OF  DIMENSION  N  BY  N. 

B698=C 

8718=C 

8728=  COHPLEX  A<16,»),B<16,<) 

8738*  INTE6ER  I,J,N,H 


B-31* 


tU '->  -r  -V  ‘.-V '/-V.V  /.V. 


>  % 


8740=  DO  Iff  1=1, N 

8731=  DO  Iff  J«1,H 

8761=  B(I, J)=A(I, J) 

877#=  Iff  CONTIWJE 
878#*  END 

879f*C 

B8ff*C  END  SUBROUTINE  COPYHT  - 

881f=C 

882f*C 

B83f*  SUBROUTINE  CHTQUT<A,H,N) 

884f*C 

886f=C 

887f*€  THIS  ROUTINE  OUTPUTS  AN  H  BY  N  COHPLEI  MATRIX  A 
888f=C 

89ff=C 

8?lf*  COHPLEI  A<16,») 

892f=  INTE8ER  I,J,H,N 

893f=  PRINT* 

894f*  DO  Iff  1=1, H 

895#=  PRINT’ 1*  *,3(2(E9.3,2I),2I))’, (A(I, J), J*1,N) 

896f=  PRINT* 

897#=  Iff  CONTINUE 
898f*  END 

899f=C 

9fff=C  END  SUBROUTINE  CHTOUT  - 

9llf«C 

9f2f=C 

9f3f*  SUBROUTINE  RPOUT (A, SCRACH, N, N> 

9f4f=C 

9f5f*C********************************************************************* 

9f6f*C 

9f7f=C  THIS  ROUTINE  PRINTS  OUT  THE  REAL  PARTS  OF  A  COHPLEI  HATRII  A 
9f8f=C 

91ff=C 

91 lf=  COHPLEI  A<16,») 

912f*  REAL  SCRACH 1 16, ») 

913#=  INTE6ER  I,J,N,H 

914f*  DO  Iff  1=1, H 

9130=  DO  Iff  J=1,N 

916f=  SCRACHU,  J)=REAL(A(I,J)) 

9170=  Iff  CONTINUE 
9180=  DO  20#  1=1, H 

919f*  ‘  PRINT’!*  •,5<E11 .4,31) ) ' , (SCRACHU, J),J=1,N) 

92##*  PRINT* 

92!f=  20#  CONTINUE 
9220=  END 
923f=C 

924f=C  END  SUBROUTINE  RPOUT  - 

923f«C 

926f=C 

9270=  SUBROUTINE  CDSCRT(A,N,TSAHP,CPHI.CPHINT,H,TP,TIDENT,CNORK) 


B-35 


£ 


•  .'.Vs  *% . 

VaV'.V.-a.v. 


CvSvv* 


93McC 

9310=C  THIS  ROUTINE  APPROXIMATES  THE  STATE  TRANSITION  MATRIX  AND  ITS 

932>SC  INTE6RAL  FOR  A  TIME  INVARIANT  LINEAR  SYSTEM  AS  A  MATRIX  EXPONENTIAL 

9330*C  OVER  A  SHALL  SAMPLE  PERIOD.  RESULTS  RETURNED  IN  COMPLEX  MATRICES. 

934*»C  A=  SYSTEM  DYNAMICS  MATRIX,  TYPE  COMPLEX 

9350*C  N*  STATE  DIMENSION 

9360*C  TSAMP=  SAMPLINS  PERIOD 

9370*C  CPHI*  STATE  TRANSITION  MATRIX,  TYPE  COMPLEX 

93fi9sC  CPHINT*  APPROXIMATE  INTESRAL  OF  CPHI,  TYPE  COMPLEX 

9390*C  M=  NUMBER  OF  TERNS  USED  IN  EXPONENTIAL  EXPANSION 

9410*0  TP,  TIDENT  AND  CMORK  ARE  DUMMY  ARRAYS 

9410=C 

9420=C«*»****t*»«**##mt**m«*mm***»m»«mmm*#*m*m*#«**« 

943I=C 

9440*  COMPLEX  A(16,«),CPHINTaB,»),CPHI(li,*),CT,TIDENT(16,«),TP(16,t) 

9430*  COMPLEX  CN0RK(16,»),CRIJ 

9460*  REAL  TSANP.R1J 

9470*  INTE6ER  I,J,H,N 

9480*  CT=CMPLX(TSAMP,0.0) 

9490*  DO  200  1*1, N 

9300*  DO  100  J*i,N 

9310*  TIDENT(I,J)*CM>LX{0.0,0.0) 

9320*  100  CONTINUE 

9330=  TIDENT(I,I)*CHPLX(1.0,0.0) 

9340=  200  CONTINUE 

9330*  CALL  CSHULICT, TIDENT, CPHINT, N,N) 

9360*  CALL  COPYHT(CPHINT,TP,N,N) 

9370*  CALL  CSMUL(CT,A,CPHI,N,N1 

9380*  DO  300  1*1, M 

9390*  CALL  CHATML ( TP, CPHI , CMORK , N, N, N) 

9600=  CALL  OJPYHT (CNORK, TP, N, N) 

9610*  RIJ*1.0/REAL(I+1) 

9620*  CRIJ*CMPLX(RIJ,0.0) 

9630*  CALL  CSMUL(CRIJ,TP,TP,N,N> 

9640*  CALL  CMATAD (CPHINT, TP, CPHINT, N,N> 

9630*  300  CONTINUE 

9660*  CALL  CMATHLIA, CPHINT, TP, N,N,N> 

9670*  CALL  CMATAD(TIDENT,TP,CPH1,N,N) 

9680*  END 

9690=C 

9700*C  END  SUBROUTINE  CDSCRT  - 

9710*C 

9720*C 

9730*  SUBROUTINE  SETPLT(A,N,N,X) 

9740-C 

9760*C 

9770*C  THIS  ROUTINE  CONVERTS  A  REAL  MATRIX  OF  DIMENSION  N  BY  N  INTO  A 
9780*C  VECTOR  THAT  IS  COMPATIBLE  NITH  R.N.  FLOYD’S  PRINTER  PL0TTIN6 
9790*C  ROUTINE,  PLOTLP.  THE  INPUT  MATRIX  IS  A. 

980#*C  N>  RON  DIMENSION  OF  A,  THE  NUMBER  OF  POINTS  TO  BE  PLOTTED 
9810*C  H*  COLUMN  DIMENSION  OF  A,  THE  NUMBER  OF  FUNCTIONS  TO  BE  PLOTTED  +1  * 


982M  X*  THE  PL0TTIN6  VECTOR,  DIMENSION  N*N 
983#*C 

983#*C 

9861*  REM.  A(N,H),X(N*H) 

987«>  INTE6ER  N,H,I,J 

988#*  DO  IN  J*1,H 

989#*  DO  If#  1*1,  N 

99##*  X(I*4J-1)*N)*AU,J) 

991#*  IN  CONTINUE 
992#*  END 

993#*C 

994#*C  END  SUBROUTINE  SETPLT  - 

995#*C 

996#*C 

997#*  SUBROUTINE  PLOTLP(A,N,N, IPSC, I SCL, LPTERM, TITLE) 

ttb§*L 

1####*C 

1H1#*C  THIS  ROUTINE  NAS  ADAPTED  FROM  R.N.  FLOYD’S  THESIS  TO  PRODUCE 
1H2#-C  PRINTER  PLOTS  OF  COMPUTED  RESULTS. 

1M3#*C  A-  VECTOR  OF  DATA,  CONVERTED  FROM  MATRIX  FORM  BY  SUBROUTINE  SETPLT 
1##4#*C  N*  NUMBER  OF  POINTS  < INBEPENBENT  VARIABLE)  TO  BE  PLOTTED 
1##3#*C  M*  NUMBER  OF  FUNCTIONS  (OEPENBENT  VARIABLES)  TO  BE  PLOTTED 
1##6#*C  IPSC  *  -1 — >ALL  VARIABLES  SCALED  TOGETHER  (1  PLOT) 

1M7#*C  *  •— >SCALED  TOGETHER  AND  SEPARATELY  (2  PLOTS) 

lf#8#«C  *  ♦!— >SCALED  SEPARATELY  41  PLOT) 

1#«9#*C  ISCL  *  • — >PL0T  OVER  EXACT  RANGE  OF  VARIABLE 
1#1N*C  *1— >PLOT  NITH  EVER  SCALING 

1#U#-C  LPTERM  *  • — >P10T  S#  CHARACTERS  HIDE 
1#12#*C  +1 — >FL0T  IN  CHARACTERS  HIDE 

1#13#*C  TITLE  *  MAX  OF  3#  CHARACTERS,  TYPE  CHARACTER 


1#14#*C 


1#16#*C 
1#17#» 
1#18#* 
1#19#* 
1#2##* 
1#21«* 
1«220* 
1#23#> 
1B24#* 
l#23f* 
1#264* 
1#27#> 
1#28#> 
1129#* 
1#3N* 
11311* 
1132#*  23 
1#33#> 
1#34#* 


REAL  YSCAL(A),YHIN(A),YPR411),RISPAC,RHIN,RHAX,YL,YH,XPR,A(») 
REAL  SCAL 

INTEGER  IBLNK46) ,  IPSC,  I SCL, LPTERM,  IPAPER,  ISPAC,  IPRTI.  ISC, J,  IC.  IX 
INTEGER  IL, JP, I TEMP, Ml, M2, H,N, ICO, I 
CHARACTER  TITLE«3# 

CHARACTER* 1  BLANK, PLUS, COLON, GRID, SYMBOL (6), OUT  I  HI) 

DATA  BLANK, PLUS, COLON, SYHBOL(l),SYHDOL42)/’  V*V:’,T,,2'/ 
DATA  SYMD0L(3),SYNfl0L(4),SYNB0L(3),SYNB0L(A>/’3’,’4’,’3’,’6’/ 
IPAPER«3*<1*LPTERH) 

ISPAC* II* I PAPER 
RISPAC-REAL (ISPAC) 

ISPAC*ISPAC*1 

IPRTI»IPAP£R*1 

RMIN*A(N*1) 

RHAX*RNIN 
DO  41  ISC*1,H 
M1«ISC»N*1 
YL*A(M1) 


10360* 

N2*N*dSC+l) 

11371* 

DO  40  J*«1,N2 

11381* 

IF(A(J)  .LT.YDTHEN 

1139#* 

YL*A(J) 

114##* 

END  IF 

11411* 

IF  <A(J) .8T.YH) THEN 

1142#* 

¥H*A(J) 

1143#* 

END  IF 

1#44#>  4# 

CONTINUE 

1#4S#* 

IF(YL.LT.RNIN)TH£N 

10440* 

RHIN-YL 

l#47f* 

END  IF 

1#48#* 

IF<YH.6T.RNAX)THEN 

1#49#> 

RMX*YH 

115##* 

END  IF 

1#31«* 

IFdPSC.6E.0)THEN 

1»52#= 

CALL  VARSCLJYL, YH,  YSCAUISC)  .RISPAC,  ISCL) 

1#53#» 

END  IF 

1054#* 

YNIN(ISC)*YL 

1033#*  41 

CONTINUE 

10560* 

IFdPSC.LE.0)  THEN 

10370* 

CALL  VARSCL(RNIN,RHAX,SCAL,RISPAC,ISCL> 

10380* 

END  IF 

10590* 

IC*2-IA8S(IPSC) 

10400* 

DO  42  IX«lf ISPAC 

10610* 

OUT (IX) «BLANK 

10620*  42 

CONTINUE 

10630* 

DO  100,ICO*1,IC 

10640* 

PRINT’ (*r,  111,  A30)’, TITLE 

10650* 

NRITE14,  ’  dlX,A50)MTlTLE 

10660* 

NRITE14,’ (ADM  BLANK 

10670* 

PRINT# 

10680* 

DO  60  1*1,  N 

10690* 

XPR*A(D 

10700* 

IF (nOS( I, 10) . EQ. 0) THEN 

10710* 

8RID*C0L0N 

10720* 

ELSE 

10730* 

6RID*BLANK 

10740* 

END  IF 

10730* 

DO  44  11*2, ISPAC, 2 

10760* 

0UT(IX)*6RID 

10770*  44 

CONTINUE 

10780* 

00  46  11*1, ISPAC, 10 

10790* 

0UT1»)*PLUS 

10800*  46 

CONTINUE 

10810* 

DO  33  J*1,N 

10820* 

IL*I#J»N 

10830* 

IFdPSC.EQ.-DTHEN 

10840* 

JP*INT((AdLHWIN)/SCAL)#l 

10830* 

ELSE  IF(IPSC.EO.0)THEN 

10860* 

IPSCT«IPSCMCO 

10870* 

IF ( IPSCT.EB. 2) THEN 

10880* 

1P*INT<  (AdU -YNIN(J)) /YSCAL  (J)M 

10890* 

ELSE 
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1#9##« 

JP*IMT ( (A(IL)-RNIN) /SCALI+1 

H91#* 

END  IF 

1#92#» 

ELSE 

1#93#» 

JP*INT  ( !A(IU-YRIN(J) )  /YSCAL! J) )  +1 

1#94«* 

END  IF 

1#93#*  3# 

OUT ( JP) sSYNBOL ( J ) 

1#96#» 

IBLNK  t J)*JP 

1#97«*  53 

CONTINUE 

1#98«* 

PRINT’!'  ',F11.4,4X,1#1A1)’,XPR,!0UT<IX),II*1 

1#99#* 

NRITEI4,  ’  (FU.4«6Xf  IDIAD'IXPR,  (0UT(IX),IX*1, 

11###* 

DO  59  J*1,H 

Ufl#* 

ITEHP*18LNK(J) 

1102#* 

OUT (ITEHP) “BLANK 

U#3#«  39 

CONTINUE 

U#4#>  6# 

CONTINUE 

11#3#* 

IFIIPSC.NE.DTHEN 

11 #6#* 

IF(IPSCT.NE.2)THEN 

11171= 

YPR(1)«RNIN 

n#e#* 

DO  7#  l*l,IPAPER 

U#9f* 

YPR(I+1)*YPR(I)*1#.*SCAL 

111##*  7# 

CONTINUE 

nil#* 

PRINT’!*#  SCALE  V1E1#.3)’,(YPR(I),T 

1112#* 

MRITE!4V ’ (All  *  XBLANK 

1113#* 

WRITE  <4f ’ ! '  SCALE  *tllEl#.3>’) (YPR(I) 

1114#* 

MRITE(4y ’ <A1) ’ ISLANK 

1113#* 

NRITE!4,’(A1)’) BLANK 

1116#* 

END  IF 

1117#* 

END  IF 

1118#* 

IFdPSC.  ER.  l.OR.  IPSCT.EB.2)  THEN 

1119#* 

DO  76  ISC*1,H 

112##*  YPRU)-YNIN(ISC) 

1121#*  SO  74  M.IPAPER 

11221*  YPR!I+1)*YPRII)*1#.*YSCAL(ISC) 

11231*  74  CONTINUE 

1124#*  PRINT’!'#  SCALE  ", A1 , IX, 1 1E1*. 3) ’ , SYHBOL ( ISC) f ( YPR( IX) 

1123#*  1,IX*1,IPRTI) 

1126#*  MRITE 14t ' (At) * ) BLANK 

1127#*  NRITE<4,’<'  SCALE  ',A1,1X,11E1#.3)')SYRB0L(ISC), 

1120#-  1 IYPRUI),  IX*1,IPRTI) 

1129#*  76  CONTINUE 

113##*  END  IF 

1131#*  DO  9#  ISC*1,6#-N 

1132#*  NRITE <4, MAH’ (BLANK 

1133#*  9#  CONTINUE 

1134#*  1##  CONTINUE 

1133#*  PRINT’ Cl')' 

1136#*  END 

U37#*C 

113fl#*C  END  SUBROUT I  IE  PLOTLP - 

U390*C 
1 14##*C 

1141#*  SUBROUTINE  VARSCUXHIN,  XHAX , SCALE , RSPACE ,  ISCL) 

U42#*C 


1145#*C  THIS  IS  A  SCALING  ROUTINE  THAT  SUPPORTS  PLOTLP 

U46#«C  ADAPTED  FROM  R.H.  FLOYD'S  THESIS 

1147#*C 


1149#*C 

115##*  REAL  XHIN, IIMI, SCALE, RSPACE, EXP,  XHINT , XHAXT 

11311*  INTEGER  ISCL.ISCAL 

11321*  IF(XIMX.EQ.IHIN)  THEN 

1133#*  XHIN«.9*XHIN-1#, 

1134#*  END  IF 

11331*  SCALE*XHAX-XHIN 

USA#*  IF(ISCL.NE.#)TH£N 

11371*  EXP*INT<1##.  *061#  (SCALE)  )-t##. 

1138#*  F ACTOR* 1#.»*(1. -EXP) 

1139#*  XHINT*XHINtF ACTOR 

116##*  XNAXT*XNAXtF ACTOR 

1161#*  IF < XHAXT. SE.#.) THEN 

1162#*  XHAXT*XHAXT*.9 

1163#*  END  IF 

1164#*  IF(XHINT.LE.#.)THEN 

1163#*  XNINT*XHINT-.9 

1166#*  END  IF 

1167#*  XHINT*AINT(XHINT) 

1168#*  ISCAL-XNAXT-XHINT 

1169#*  IF<H0D(ISCAL,3).NE.#)THEN 

117##*  ISCAL»ISCAL*5-H0D(ISCAL,3> 

1171#*  END  IF 

1172#*  FACTOR»l#.«* (EXP-1.) 

1173#*  XHIN*XHINT«FACTOR 

1174#*  SCALE*FACTOR*REAL ( ISCAl) 

1173#*  END  IF 

1176#*  SCALE*SCALE/RSPACE 

1177#*  END 

1178#*C 

1179#*C  END  SUBROUTINE  VARSCL - 


118##*C 

1181#*C 

1182#*  SUBROUTINE  EDIT(EDHAT,H,N,SCRACH) 

1183#*C 

1I84#*C*hhhhhihhihhhhhhhhim«hhhmhihhhhihhihhih 

1183#*C 

1186#*C  THIS  ROUTINE  ALLONS  THE  USER  TO  EDIT  AN  H  8Y  N  MATRIX  EDNAT 
1187#*C 


U89#*C 

119##* 

COMPLEX  EDHAT(16,»> 

1191#* 

REAL  EL,SCRACH(16,») 

1192#* 

INTEGER  H,N,I,J 

1193#* 

CHARACTER  ANSNH 

1194#*  1# 

PRINT*, *LIST  CURRENT  VALUES?  Y/N:  ' 

1193#* 

READ(*,’ (A) ’ ) ANSU 

1196#* 

IF (ANSN.NE. ’ Y’ . AND. ANSN.NE. ’N’ )  60  TO  1# 

1197#* 

IF(ANSN.EQ.’Y')  CALL  RPOU T ( EDHAT , SCRACH, R , N ) 
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•  ,V ,  •  #  •  ,*  *  ‘  'M 


_  .  w  i. 


«-•  il’V 


11981*  PRINT*,’ ENTER  1,1,1  <CR>  MSN  ALL  CHANGES  HAVE  BEEN  HADE’ 

11991*  1M  PRINT’ C  ENTER  RON  I,  COLURN  I,  AND  MATRIX  ELEMENT-  *, 

121##*  1  12, II, ’BY',  12, ‘I  *  )’,lf,N 

1211#*  11#  READ*, I, J, EL 

12#2#>  IF ( I .6T. #. AND. I .LE.H. AND. J. 6T. #. AND. J. LE. N) THEN 

12#3#«  EDHAT(I,3)*CHPLX(EL,#.#> 

12#4#>  60  TO  11# 

12#5#«  ELSE  IF(I. EB.f. AND. J.EB.f) THEN 
12#6«*  IS#  PRINT*, ’LIST  MODIFIED  MATRIX?  Y/N:  ’ 

12#7#»  READ(*,'(A)’)ANSN 

12#8f*  IFIANSN.NE.’Y’.AND.ANSN.NE.’N’)  60  TO  IS# 

12#9#*  IF(ANSN.EB.’Y’)  CALL  RPOUT(EDMT,SCRACH,N,N) 

121##*  2##  PRINT*, ’ANY  MORE  CHANGES  TO  THIS  MATRIX?  Y/N:  ’ 

1211#*  READ(»,’(A)’)ANSN 

1212#*  IFIANSN.NE.’Y’.AND.ANSN.NE.’NMGO  TO  2## 

1213#*  IFIANStt. Efl.'Y’)6Q  TO  1#« 

1214#*  IF (ANSN.EB.’N’) RETURN 

1215#*  ELSE 

1216#*  PRINT*, ’SUBSCRIPT  OUT  OF  RAN6E’ 

1217#*  GO  TO  IN 

1218#*  END  IF 

1219#*  END 

122##*C 

1221#*C  END  SUBROUTINE  EDIT - 

1222#*C 

1223f*C 

1224#*  SUBROUTINE  CXPOSE(A,B,H,N) 

1223#*C 

122A#*C*****»***************************************************»*********** 

1227#*C 

1228#*C  THIS  ROUTINE  HILL  TRANSPOSE  AN  R  BY  N  COHPLEI  HATRIX  A 

1229#*C  THE  RESULT  IS  AN  N  BY  H  CORPLEX  RATRIX  B 

123##*C 

1 231  Kt*HtH*tHt*HHHHHt**44tt**tHtt***tHHHttit«*m*HtH**IHt 

1232#*C 

12330*  COMPLEX  A<16,»),8U6,*> 

1234#*  INTEGER  I,J,R,N 

1235#*  DO  IN  1*1,  N 

1236#*  DO  1##  3*1, H 

1237#*  B(I,3)*A(J,I) 

1238#*  IN  CONTINUE 
1239i*C 

124##*C  END  SUBROUTINE  CXPOSE  - 

1241#*  END 


C.  ODEACT  Software  Description  and  Instructions 

C. 1  Introduction 

ODEACT  is  an  interactive  computer  program  that  was  developed  to 
provide  the  capability  to  evaluate  the  controller  designs  of  this  study 
with  respect  to  actuator  nonlinearities  (specifically  saturation,  for 
this  research).  The  purpose  of  this  appendix  is  to  outline  the  program 
structure  and  explain  its  use.  A  sample  execution  and  the  complete 
source  code  listing  are  included. 

ODEACT  employs  an  integration  package  called  "ODE"  [42]  to  simulate 
the  controller  time  response,  with  various  system  truth  models,  to 
non-zero  initial  conditions  and  command  inputs.  User  options  include 
the  choice  of  one-,  three-,  or  four-state  actuator  models  as  defined  in 
Section  4.3;  the  selection  of  linear  or  rate-  and  position-limited 
nonlinear  actuators;  the  addition  of  anti-windup  compensation  to  the 
control  law,  as  developed  in  Section  5.7;  and  variation  of  plant  truth 
model  parameters  for  the  pitch,  angle  of  attack  and  pitch  rate  states 
through  redefinition  of  the  appropriate  elements  of  the  truth  model 
dynamics  matrix. 

Unlike  CGTSVD,  ODEACT  is  a  special  purpose  program  and,  in  its 
present  form,  is  only  useful  for  analysis  of  deterministic  CGT/PI 
controller  designs  based  on  the  five-state  design  model  for  the  AFTI 
F-16  pitch-pointing  system,  as  defined  in  Section  4.2.  While  not 
directly  'usable  for  analysis  of  other  designs,  ODEACT  can  serve  as  a 
model  analysis  tool  which  could  easily  be  adapted  to  other  problems. 
Because  its  purpose  is  so  specialized,  the  structure  of  ODEACT  is 
extremely  simple.  As  with  CGTSVD,  sophisticated  progamming  practices 


were  clearly  unnecessary;  the  load  size  for  ODEACT  is  only  about  42,000 
octal  words  of  memory.  The  program  is  written  in  ANSI  standard  FORTRAN 
77.  The  source  code  is  explained  by  numerous  comments,  and  the  prompts 
during  execution  are  sufficient  in  number  and  detail  to  assist  the 
novice  user;  the  additional  comments  and  clarification  provided  in  this 
appendix  will  therefore  be  brief. 

C.2  ODEACT  Program  Structure 

ODEACT  is  entirely  self  contained  except  for  the  use  of  the 
subroutine  "ODE"  [42]  which  is  maintained  in  the  CC6600  library  on  the 
CYBER  computer.  Many  of  the  utility  subroutines  are  simply  adaptations 
of  those  used  in  CGTSVD,  but  using  real  variables  and  arithmetic, 
rather  than  complex.  Also,  matrix  partitions  of  larger  arrays  are  not 
used  in  the  calculations,  so  row  dimensions  are  passed  as  arguments  to 
the  matrix  manipulation  routines,  eliminating  the  need  to  employ  the 
inefficient  practice  of  blocking  all  matrices  with  a  common  row 
dimension. 

The  program  utilizes  the  basic  design  model  dynamics  description 
of  the  AFTI  F-16  found  in  Section  4.2,  except  that  the  state  dimension 
is  expanded  from  5  to  11  to  allow  for  up  to  4  states  for  each  actuator. 
This  means  that  the  trailing  edge  flap  state,  which  was  originally 
state  5,  becomes  state  8.  Since  the  actuator  models  and  the  control 
input  matrix  are  "hardwired"  into  the  program,  this  alteration  is 
transparent  to  the  user  except  when  inputting  the  dynamics  matrix  (k), 
the  output  matrix  (C)  and  the  matrix,  as  discussed  in  Section  C.3. 

ODEACT  assumes  that  design  parameters  will  be  read  in  from  a 
previously  developed  data  file  at  line  670;  if  this  is  not  the  case, 


keyboard  inputs  are  made  at  line  920.  In  either  case,  the  user  is 
permitted  to  change  any  parameters  before  each  simulation  run  via  the 
"change  menu"  at  line  1440,  and  to  save  each  set  of  parameters  to  a 
data  file.  Once  the  parameters  have  been  established,  the  CGT  command 
model  is  discretized  (line  1880),  the  actuator  model  and  control  law 
options  selected  (line  2000),  and  initial  conditions  and  input  command 
are  specified  (line  2310).  In  ODEACT's  current  form,  initial  condi¬ 
tions  may  be  applied  to  any  state,  but  command  inputs  are  limited  to 
step  inputs  to  the  pitch  angle.  This  can  be  changed  by  modifying  the 
code  beginning  at  line  2430.  The  plotted  outputs  are  the  pitch  angle 
(represented  by  the  symbol  "1"),  flight  path  angle  (symbol  "2"),  and 
actuator  states  (symbol  "3"  for  the  horizontal  tail,  symbol  "4"  for  the 
trailing  edge  flap);  this  can  be  changed  by  modifying  the  code 
beginning  at  line  2510. 

The  control  input  for  each  sample  period  is  calculated  by  a  call 
to  subroutine  "GCSTAR"  at  line  2670;  "GCSTAR"  propagates  the  command 
model  to  define  the  new  command  model  states,  and  then  calculates  the 
controls  as  defined  in  (11-25).  The  control  inputs  are  modified  for 
anti-windup  compensation,  as  defined  in  Section  5.7,  if  that  option  is 
selected.  "00E"  is  then  called  to  propagate  the  system  states  over  the 
ensuing  sample  period.  There  are  three  alternative  calling  statements 
for  "ODE,"  differing  only  in  the  first  argument,  which  is  the  argument 
that  specifies  the  subroutine  containing  the  selected  actuator  model. 
"FI"  contains  the  single-state  model,  "F3"  the  three-state,  and  "F4" 
the  four-state  model.  Each  of  these  subroutines  contains  the  set  of 
ordinary  differential  equations  that  make  up  the  appropriate  dynamics 
description  for  overall  controlled  system  which  "ODE"  calls  repeatedly 


during  the  conduct  of  the  integration.  If  nonlinear  actuators  are 
specified  by  the  user,  then  rate  and  position  limits  are  applied  to  the 
actuators  in  these  subroutines.  For  example,  if  the  actuator  position 
state  reaches  a  positive  position  limit,  then  its  derivative  is 
constrained  to  be  non-positive.  If  the  state  derivative  reaches  a 
positive  rate  limit,  then  the  next  derivative  is  constrained  to  be 
non-positive. 

The  plotted  output  for  each  simulation  includes  51  points,  regard¬ 
less  of  the  duration  of  the  response.  The  time  interval  between  the 
points  is  an  integer  multiple  of  the  sample  period  chosen  to  ensure 
that  the  specified  response  duration  is  covered  by  the  plot.  When 
"ODE"  completes  the  integration  over  a  sample  period,  the  states  are 
stored  in  the  "OUT"  array  if  the  current  time  is  a  plot  interval,  and 
then  the  next  sample  period  is  begun  with  a  call  to  "GCSTAR" . 

When  the  simulation  is  completed,  the  user  is  given  the  option  to 
change  any  design  parameters  or  exit  the  program  through  the  code  at 
line  2970.  When  the  single-state  actuator  model  is  used,  1  second  of 
simulation  uses  about  0.5  seconds  of  processor  time  on  the  CYBER 
computer.  When  the  four-state  actuator  model  is  used,  2  to  3  seconds 
of  processor  time  is  required  for  a  1  second  simulation,  the  longer 
time  being  applicable  when  actuator  nonlinearities  are  simulated. 

These  times  apply  to  the  program  as  listed  in  Section  C.5;  the  amount 
of  processor  time  used  can  be  reduced  by  increasing  the  values  of  the 
error  tolerances  specified  in  lines  2480  and  2490.  In  fact,  the 
tolerances  listed,  which  were  the  ones  used  for  this  study,  were 
without  doubt  much  smaller  than  necessary  to  achieve  good  accuracy  in 
the  simulation.  Tests  with  both  error  tolerances  set  at  0.001  did  not 


visibly  affect  the  plotted  results,  and  provided  a  50J  savings  in 
processor  time  with  the  four-state  actuator  model.  Applicable  error 
tolerance  selection  for  "ODE"  is  a  function  of  the  problem  being  run, 
and  is  discussed  at  length  in  [42]. 

C.3  Instructions  for  Using  ODEACT 

Prior  to  executing  ODEACT,  any  previously  developed  data  files 
that  are  to  be  used  must  be  attached.  File  usage  by  ODEACT  is  the  same 
as  that  outlined  in  Appendix  B  for  CGTSVD,  with  the  exception  that 
ODEACT  will  overwrite  a  previously  established  data  file.  Data  files 
for  ODEACT  are  not  compatible  with  those  for  CGTSVD  or  CGTPIV.  The 
library  containing  "ODE"  (CC6600  for  the  Aeronautical  Systems  Division 
CYBER  computer)  must  also  be  attached  and  declared  as  a  library. 

Once  the  program  execution  begins,  the  user  need  only  respond  to 
the  program  prompts.  Only  the  non-zero  elements  of  any  matrix  need  to 
be  entered.  The  only  "trick"  to  using  the  program  is  to  remember,  when 
inputting  the  A,  C  or  matrices  (which  go  by  the  same  names  in  the 
program  output),  that  what  would  normally  be  the  elements  of  the  fifth 
column  (elements  tied  to  the  trailing  edge  flap  state)  must  be  entered 
as  the  eighth  column,  regardless  of  which  actuator  model  is  selected. 
Only  the  first  3  rows  of  the  A  matrix  are  entered,  since  the  rest 
represent  actuator  states  already  represented  in  program  subroutines. 
The  CGT  command  model  is  represented  in  the  "AM",  "BM"  and  "CM" 
matrices.  The  command  model  used  must  be  of  dimension  4  or  less; 
internally,  the  program  uses  a  four-state  representation  in  any  case, 
and  unused  elements  of  these  arrays  are  simply  set  to  zero  and  do  not 


affect  the  results 


All  of  the  time-response  plots  displayed  at  the  terminal  are  also 
written  to  a  plot  file  named  by  the  user.  Upon  exit  from  the  program, 
the  plot  file  can  be  saved  or  routed  to  a  printer  to  obtain  a  "hard" 
copy  of  the  results. 

C.4  Sample  Program  Execution 

The  pages  that  follow  contain  a  short  sample  run  of  OOEACT  on  the 
CYBER  computer.  The  object  code  is  the  file  named  ODEACT  and  the  data 
file  ODESRB  is  the  data  for  the  SR-B  CGT/PI  design  described  in  Section 
5.2.  The  computer  output  is  displayed  in  upper  case  and  the 
non-numeric  user  responses  in  lower  case  text.  The  message  concerning 
a  "NON-FATAL  LOADER  ERRORS"  is  not  significant  to  ODEACT,  but  pertains 
to  an  unused  portion  of  the  CC6600  library. 


COMMAND-  attach, odesrb 


PFN  IS 
ODESRB 

AT  CY*  Ml  SN*AFIT 

COMMAND-  attach, odeact 

PFN  IS 
ODEACT 

AT  CY*  Ml  SN»AFIT 


COMMAND-  attach, ccMM,  id*l ibrary ,  sn*asd 

PFN  IS 
CC&6M 

AT  CY*  m  SN*ASD 
COMMAND-  library,ccMM 
COMMAND-  odeact 

ENTER  NAME  FOR  PLOT  OUTPUT  FILE:  plot2 
NON-FATAL  LOADER  ERRORS  - 
NON-EXISTENT  LIBRARY  6IVEN  -  SYSIO 

DATA  TO  OE  READ  FROM  FILE?  Y/N:  y 

ENTER  NAME  OF  DATA  FILE:  odesrb 

ANY  CHAN6ES  TO  MATRICES?  Y/N:  n 

WRITE  DATA  TO  OUTPUT  FILE?  Y/N:  » 

ENTER  SAMPLIN6  TIME:  .#2 

PHI  NATRII  FOR  COMMAND  MODEL: 

.9048E+M  I.  f. 

f.  .9D48E+M  I. 


«.  I.  .1M0E+I1 


0, 


BD  MATRIX  FOR  COMMAND  MODEL: 

.9516E-01  0.  I. 

0.  .931AE-01  0.  0. 

0.  0.  0.  0. 

0.  0.  0.  0. 

1=  FOUR  STATE  2*  THREE  STATE  3«  SINGLE  STATE 
SELECT  ACTUATOR  MODEL:  3 

APPLY  ACTUATOR  RATE/POSITION  LIMITS?  Y/M:  y 

EMPLOY  AMTI-MIMDOP  COMPENSATION?  Y/M:  y 

ENTER  DESIRED  RESPONSE  DURATION:  2 

ENTER  INITIAL  CONDITIONS  FOR  STATES,  IF  NON-ZERO: 
ENTER  I  AND  Id);  0,0  TO  TERMINATE:  1,1 

•,0 

ENTER  STEP  INPUT  MAGNITUDE  FOR  PITCH  AN6LE:  0 

♦ - ENTER  TITLE  FOR  PLOT - 

staple  plot  for  sr-b  design 


SAMPLE  PLOT  F08  SR-B  DESIGN 
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1M>  PR06RAM  QDEACT 
118*C 

i3f*C 

141-C  SIMULATION  PROGRAM  TO  TEST  A  PI  RE6ULAT0R  OR  C6T/PI  PITCH-POINTING 
1S#*€  CONTROLLER  BASED  ON  A  S-STATE  NODEL  OF  THE  AFTI  F-16.  OPTIONS 
16I*C  INCLUDE  NOOIFICATION  OF  DYNAMICS  MATRIX,  USE  OF  1-,  3-  OR  4-STATE 
17f«C  ACTUATOR  MODELS,  APPLICATION  OF  RATE/POSITION  LIMITS  ON  ACTUATORS, 
181*0  AND  EMPLOYMENT  OF  ANTI-HINDUP  COMPENSATION.  USER  SUPPLIES  DYNAMICS 
19#*C  MATRIX,  OUTPUT  MATRIX,  CGT  COMMAND  MODEL  AND  CONTROLLER  SAINS  NITH 
2ff*C  THE  F0LL0NIN6  CHAN6ES: 

21f*C  1.  ONLY  THE  FIRST  THREE  RONS  OF  THE  DYNAMICS  MATRIX  ARE  ENTERED 

22#*C  2.  COLUMN  5  OF  THE  NORMAL  DYNAMICS  MATRIX  IS  ENTERED  AS  COLUMN  8 

23f=C  3.  COLUMN  5  OF  THE  NORMAL  KX  MATRIX  IS  ENTERED  AS  COLUMN  8 

24#*C  THE  COMMAND  MODEL  MUST  BE  OF  DIMENSION  4  OR  LESS 
25f*C 

26I=C  DATE  OF  LAST  REVISION:  6  SEP  83 

27I*C  LIBRARIES  USED:  CC66M,ID*LI8RARY,SN*AS0 

2flf*C 

3ff*C 

31#-  REAL  HORK(33f),Xai),DX{ii),l»JT(51,5),T,TOUT,TSANP,PLTVEC(2AI) 

321*  REAL  AM0RK(4,4),BM0RK<4,4),CM0RK(4,4),AR(4,4),BH(4,4) 

331*  REAL  RELERR,ABSERR,DSIH 

34#-  INTE6ER  I,J,K,IFLAG,3FLA6,JCFLA6,KFLA6,NFLAG,IN0RK(5),IDSIH 

351*  C0MH0N/HATRIX/A<3,ll),C(4,il),KX(2,U),KZ(2,4),KXN(2,4), 

36#-  1  KXUI2,4),PHI(4,4),PHINTI4,4),CM(4,4> 

371-  CQM10N/C0l(TRL/VHE)t(2}  ,U&.9<2)  ,UCHD14}  ,UC0LD<4> ,  IOLDI 11) , 

38#-  1  XHOLD (4) , XN (4) , HFLA6 

39#-  EXTERNAL  F1,F3,F4 

4M*  CHARACTER  ANSM*  1 ,  TI TLE*3f ,  DATA*6,  SAVE*6,  PLOT*& 

41#*C 

42KHWHtWHH»IHWWWHHHHHHHHHHHHHHiHWHWHH 

43f«C 

44#«C  FLAG  DEFINITIONS: 

43f*C  I FLAG  «  INSTRUCTIONS  FOR  ODE  INTEGRATION  SUBROUTINE;  INPUT  MUST 
4A#*C  BE  NEGATIVE,  OUTPUT  OTHER  THAN  2  SIGNALS  INTEGRATION 

47f*C  PROBLEMS. 

48A-C  JFLAG  *  MATRIX  MODIFICATION  IN  PROGRESS  IF  NON-ZERO 

49#*C  JCFLA6  *  CURRENT  COMMAND  MODEL  HAS  BEEN  DISCRETIZED  IF  JCFLA6-1 

5M*C  KFLAG  *  CHOICE  Iff  ACTUATOR  NODEL  TO  BE  USED 

51#-C  MFLAG  *  RATE/POSITION  LIMITS  APPLIED  IF  NFLAG-1 

32#*C  NFLA6  *  ANTI-NINDUP  COMPENSATION  EMPLOYED  IF  NFLA6-1 

S3#*C 

34|3Cihhmhhiihmhim><hihh<hh<hh«hihihmhhihhhh<h 

35f*C 

S8*C<hhhhhhhhhhhhhhhhhhhhhhhhhh«hhhhh«« 

37I*C 

58»*C  INPUT  SECTION.  DATA  MAY  BE  READ  IN  FROM  AN  ’OLD’  FILE,  AND  SAVED 
39#*C  TO  ANY  OTHER  FILE.  ONLY  ONE  SET  OF  DATA  PER  FILE  NAME.  PLOTS  ARE 
6#f-C  AUTOMATICALLY  SAVED  IN  A  ’PLOT  FILE’. 

610-C 

62f*CH<HHHMMH«MMH»HM<HM«Ht*»MMHM<»»MMH»HMH 

63#-C 


641*  If 

PRINT*,’ ENTER  RARE  FOR  PLOT  OUTPUT  FILE:  ’ 

6  31* 

READ(*,’(A)’)PLOT 

661* 

0PENI4,FILE*PL0T, STATUS*’ MEN’, FORM*’FORRATTEO',ERR*l#) 

671*  2# 

PRINT*, 'DATA  TO  BE  READ  FROM  FILE?  Y/MS  ’ 

681* 

READ!*,’ (Al’)ANSH 

69#* 

IF(ANSN.NE.’Y’.AND.ANSN.NE.’N’)  60  TO  2# 

71#* 

IF(ANSN.EO.’N’)  60  TO  3# 

71#* 

0CFLA6*# 

72#* 

PRINT*, ’ENTER  NAHE  OF  DATA  FILE:  ’ 

73#* 

READ!*, ’(A)’) DATA 

74#* 

OPEN (2, FILE*DATA, STATUS*’ OLD’ , FORK*’ UNFORMATTED’ , ERR*2#> 

75#* 

RE  AD(2M  (At  1,0),  1*1,3),  0*1,11) 

76#* 

READ(2) t(C(I,0), 1*1,4), 0*1, 11) 

77#* 

READ(2)((KX(I,0I,I*1,2),0*1,11) 

78#* 

READ12)  ((KZU,0),I*1,2),0*!,4) 

79#* 

READ(2)((K1U(I,0),I*1,2),0*1,4) 

8##* 

READ(2)t<KXH(I,0),I*i,2),0*l,4) 

81#* 

READ<2)((AH(I,0),I*i,4),0=l,4) 

82#* 

REA0I2) <(BN(I,0),I*1,4),0*1,4) 

83#= 

REA0(2X(CM(I,0),I*1,4),0*1,4) 

84#* 

REHIND42) 

85#* 

CLOSE (2) 

86#* 

60  TO  14# 

87f*C 

88#*C  FOR  KEYBOARD  INPUT,  ONLY  NON-ZERO  MTRI!  ELEMENTS  ARE  REBUIRED. 
89#«C  NO  NON-ZERO  ENTRIES  SHOULD  BE  MADE  FOR  COLUMNS  3,6, 7,9,1#  OR  11 
9##*C  OF  A  OR  Kl,  BUT  NO  PROTECTION  PROVIDED  ASAINST  DOING  SO. 

9l#*C 
92#*  3# 

DO  3#  1*1,3 

93#* 

DO  5#  0*1,11 

94#* 

A(I,0)*#.# 

95#*  5# 

CONTINUE 

96#* 

DO  64  1*1,11 

97#* 

DO  6#  0*1,2 

98#* 

XXO, !)*#.# 

99#*  6# 

CONTINUE 

1###* 

DO  64  K*l,4 

l#lf= 

CIK, I)*#.# 

1020-  64 

CONTINUE 

1#3#> 

DO  66  1*1,2 

1#4#* 

DO  66  0*1,4 

1(5#* 

KZ(I,0)*#.f 

1#6#> 

KXUII.O)*#.# 

1#7#> 

KlN(I,0)*#.f 

1#8#»  66 

CONTINUE 

1#9#* 

DO  7#  1*1,4 

11##* 

DO  7#  0*1,4 

111#* 

AH(I,0)># 

112#* 

BH(I,0)*f 

113#* 

cn ( i , o  >  *# 

114#*  7# 

CONTINUE 

115#* 

JFLA6*# 

116#*  72 

PRINT*, ’ENTER  DYNAMICS  MATRIX:  ’ 

117#* 

CALL  EDIT(A,3,11) 

f.  .'  .■  .■  V 

V  J  ’•  V  ■>  ’.•■■•••  •  • . 

»’•*-*•  *  •  *  •  *  •  ’  ■  ‘  *  *  - . *  *  ' 

L 

Lm 

;-v- 

j*  • 

*  »  *  < 

1184* 

IF ( JFLA6.NE. 4)  60  TO  144 

1194s  76 

PRINT*,' ENTER  OUTPUT  MATRIX:  ’ 

•  ■/  **  >  * 

1244* 

CALL  EDIT (Cf 4, 11) 

1214* 

IF ( JFLAG. NE. 4)  60  TO  144 

1224*  78 

PRINT*, 'BITER  KI  MATRIX:  ’ 

1234* 

CALL  EDIT  1X1,2,11) 

1244* 

IF ( JFLA6.NE. 4)  60  TO  144 

r«/\' 

1254*  84 

PRINT*, ’ENTER  XZ  MATRIX:  ’ 

gym  ■  $ 

1264* 

CALL  EDIT <KZ,2f  4) 

1274* 

IF1JFLA6.NE.4)  60  TO  144 

1284*  82 

PRINT*, ’ENTER  KIN  MATRIX:  ’ 

1294* 

CALL  EDIT (KIN, 2, 4) 

•  * 

1344* 

IF1JFLA6.NE.4)  60  TO  144 

1314*  84 

PRINT*, ’ENTER  KXU  MATRIX:  ’ 

1324* 

CALL  EDIT 1KXU,2, 4) 

n 

1334* 

IF1JFLA6.NE.4)  60  TO  144 

1344*  86 

PRINT*, ’ENTER  MODEL  DYNAMICS  MATRIX:  ’ 

1354* 

JCFIA6*4 

1364* 

CALL  EDIT (AM, 4, 4) 

ft? 

1374* 

IF13FLA6.NE.4)  60  TO  144 

1384*  88 

PRINT*, 'ENTER  H0D&  CONTROL  MATRIX:  ’ 

iHi 

1394* 

JCFLA6*4 

1444* 

CALL  EDIT(M,4,4) 

1  V »  * 

1414* 

IF1JFLA6.NE.4)  60  TO  144 

&} 

1424*  94 

PRINT*, ’ENTER  MODEL  OUTPUT  MATRIX:  ’ 

Sfrj 

1434* 

CALL  EDIT (CM, 4, 4) 

s 

1444*  144 

PRINT*, ’ANY  CHAN6ES  TO  MATRICES?  Y/N:  ’ 

M  0 

1451* 

R£AD<*,’/A)’)ANSN 

1464* 

IF1ANSN.NE. ’ Y’ . AND. ANSN.NE. ’N’ )  60  TO  144 

KvX 

1474*  142 

IF(ANSN.EO.’Y’)  THEN 

1484* 

PRINT*, ’1*A  2*C  3*KX  4*XZ  5*XXH  6*KXU’ 

f.V^ 

1494* 

PRINT*, ’7*AM  8*8M  9*CM  ENTER  CHOICE:  ’ 

1544= 

READ*, JFLA6 

ip 

1514* 

60  TO  (72,76,78,84,82,84,86,88,94)  JFLA6 

1524* 

ELSE 

1534* 

JFLA6*4 

1544* 

END  IF 

1554*  154 

PRINT*, ’NR1TE  DATA  TO  OUTPUT  FILE?  Y/N!  ’ 

1564* 

R£AD(*, ’ (A) ’ 1ANSN 

MH 

1574* 

IF (ANSN.NE. ’Y’. AND. ANSN.NE. ’N’)  60  TO  154 

1584* 

IF(ANSN.EO.’Y’)  THEN 

>  '.- 

1594* 

PRINT*, ’ENTER  NAME  OF  OUTPUT  FILE:  ’ 

;<-•. 

1644* 

REAO(*,’(A)')SAVE 

Vv 

1614* 

OPEN (3, FILE*SAVE, FORM*' UNFORMATTED’ , ERR*84) 

1624* 

NRITE(3)((A(I,J),  1*1,3),  J*l,  ID 

"1 _ 

1634* 

NRITE(3)((C(I,J),I*l,4),J*l,il) 

*\ 

1644* 

NRITE(3)((KX(I,J), 1*1, 2), J*1,1D 

^  *'• 
i*.-\ 

1654* 

NRITEI3) ((KZ(1,J),I*1,2),J*1,4) 

1664* 

NRITE13)  UXXU1I,  J),I*1,2),J*1,4) 

1674* 

HRITE (3) ( (XXM< 1 , 3) , 1*1 , 2) , J*1 , 4) 

1684* 

NRITEI3) ((AM(I,J),I*1,4),J*1,4) 

m  ^ 

1694* 

NRITEI3) ((BM(I,J),I*1,4),J*1,4) 

• .  • .  s* .  • 

-V*,  .'C*' 

1744* 

NRITE(3)(<CM(I,3),I*i,4),J*l,4> 

5ft 

1714* 

ENDFILE (3) 

C-14 

ISlillH 

1721*  REWIND (3) 

1731*  CLOSE (3) 

1741*  END  IF 

175f*C 

177#*C 

178«*C  NON  SET  UP  CONDITIONS  FOR  CALLING  DOE.  ALL  INITIAL  CONDITIONS 
179f*C  ARE  ZERO  UNLESS  CHANGED  BY  USER  INPUT.  ASSURED  C6T  INPUT 
18M*€  IS  STEP  CONHAND  ON  PITCH  STATE.  PLOTTED  OUTPUTS  ARE: 

1B1#*C  1  *  PITCH  AN6LE 

182#*C  2  *  FLIGHT  PATH  ANGLE 

183#*C  3  *  HORIZONTAL  TAIL  POSITION 

184#*C  4  *  TRAILING  ED6E  FLAP  POSITION 

1GS0-C 

187I*C 

188f*  IF ( JCFLAG. EO. f )  THEN 

1891*  PRINT*, ’ENTER  SAMPLING  TIRE:  ’ 

19M*  REAO*,TSARP 

1911*  CALL  DSCRT 4 AHy 4, TSANP, PHI y PRINT, 3«, ANORK, BHORK, CNORK) 

1921*  CALL  RATRL(PHINT,BR,AN0RK,4,4,4) 

1931*  CALL  C0PYHT(AN0RK,PHINT,4,4) 

1941=  PRINT*, 'PHI  MATRIX  FOR  COHRAND  MODEL:  ' 

195#*  CALL  RPOUT  <PH1,4,4) 

1961*  PRINT*, *  BD  HATRIX  FOR  COHRAND  MODEL:  ’ 

197#*  CALL  RPOUT (PH1NT,4, 41 

198#*  JCFLA6*1 

199#*  END  IF 

2###*  132  PRINT*, ’1*  FOUR  STATE  2*  THREE  STATE  3=  SINGLE  STATE’ 
201#*  PRINT*, 'SELECT  ACTUATOR  MODEL:  ’ 

202#*  READ*,KFLA6 

2#3f*  IF(KFLA6.6T.3.QR. KFLA6.LT. 1)  60  TO  152 

2#4#»  154  PRINT*, ’APPLY  ACTUATOR  RATE/POSITION  LIMITS?  Y/N:  ’ 

2#5#*  READ!*,' (A)’)ANSN 

206#*  IF(ANSN.lC.’y’.AND.ANSN.NE.’N’)  60  TO  154 

2970*  IF(ANSH.EO.’Y’)  NFL AG* 1 

2080*  IF(ANSN.EB.’N’)  MFLAG-0 

219#*  156  PRINT*, ’EMPLOY  ANTI -WINDUP  COMPENSATION?  Y/N:  ’ 

21##*  READ!*,  MAI  MARSH 

211#*  IFIANSH.NE.’Y’.AND.ANSH.NE.’NM  60  TO  156 

212#*  IFIANSN.EQ.'YM  NFL  AG*  1 
213#*  IFIANSN.EO.’NM  NFLAG*# 

214#*  158  PRINT*, ’ENTER  DESIRED  RESPONSE  DURATION:  ' 

215#*  READ*, OSIN 

216»*  IF(DSIH.LT.f.l)  60  TO  52# 

217#*  lDSIH*INT(DSlH/<5#.#*TSAHP>+.99) 

218#*  16#  DO  17#  1*1,11 
219#*  XU)*#.# 

22##*  XOLD( !)*#.# 

221#*  17#  CONTINUE 
2229*  DO  172  1*1,2 
223#*  UOLDU)*#.# 

2249*  172  CONTINUE 


2261*  UCMD(I)*0.0 

2271*  UCOLO(I)*f.0 

2281*  IM(I)*0.0 

2291*  xnOLD(I)*0.0 

2300*  173  CONTINUE 

2310*  PRINT*,’ ENTER  INITIAL  CONDITIONS  FOR  STATES,  IF  NON-ZERO:  ’ 
2321*  181  PRINT*, ’ENTER  I  AND  1(1)1  f, I  TO  TERMINATE:  ’ 

2331*  191  READ*, I, EL 

2340*  IFd.LE.ll.AMO. I.GE.l)  THEN 

2331*  KI)*EL 

2360*  SO  TO  191 

2371*  ELSE  IF(I.EO.I)  THEN 

2380*  60  TO  211 

2398*  ELSE 

2400=  PRINT*, ’SUBSCRIPT  OUT  OF  RANGE’ 

2411*  80  TO  181 

2420*  END  IF 

2431*  219  PRINT*, ’ENTER  STEP  INPUT  MAGNITUDE  FOR  PITCH  AN6LE:  ’ 

2441*  READ* , U01D < 1 ) 

2430*  T*0.0 

2460*  TOUT*0.0 

2470*  IFLA6*-1 

2480*  RELERR*1.E-B 

2490*  ABSERR*l.E-6 

2300*  DO  300  I*IDSIH*1,31*IDSIN*1 

2310*  IF(IDSIM.NE.1.AND.N0D(I,IDSIH).E0.1)  THEN 

2320*  J*INT ( I/ID51N) 

2530*  0UT(J,1)=T0UT 

2540*  0UT(J,2)*1(1) 

2550*  OUT ( J , 3) *X  C 1 ) -X (2) 

2560*  0UTU,4)*1(4) 

2570*  0UTU,5)*X<BI 

2580*  ELSE  IF(IDSIN.EB.l)  THEN 

2390*  J*I-IDSIH 

2600*  OUT (J, 1)*T0UT 

2610*  OUT (J,2)*X  <1) 

2620*  0UT(J,3)*X(1)-X(2) 

2630*  0UT(J,4)«1(4) 

2640*  0UT(J,3)*X(8) 

2650*  END  IF 

2660*  T(HJT*TOUT*TSAMP 

2670*  CALL  8CSTAR(I,NFLA6) 

2680*  DO  230  J*l,ll 

2690*  XOLO(J)*I(J> 

2700*  230  CONTINUE 

2710*  DO  260  3*1,2 

2720*  UOLD(J)*UNEN(J) 

2730*  260  CONTINUE 

2740*  DO  262  J*l,4 

2730*  UCOLD(J)*UCHD(J) 

2760*  XHOLD(J}*IH(J) 

2770*  262  CONTINUE 

2780*  IF(KFLAG.EO.l)  THEN 


2790*  CALL  0DEIF4, 11, X,T, TOUT, RELERR,ABSERR,IFLA6, HORN, IHORK) 


2888*  ELSE  IFCKFLA6.E6.2)  THEN 

281#*  CALL  00E(F3, 11,1,1, TOUT, RELERR, ABSERR, 2FLAfi,NORK,  INQRK) 

2828*  ELSE 

2838*  CALL  ODE ( F 1 , 1 1 , X , T , TOUT , RELERR , ABSERR , I FL AS, WORK , I WORK) 

2848*  END  IF 

2858*  T*TQUT 

2868=  IFIIFLAB.NE.2)  THEN 

2878*  PRINT’ (■  IFLAG  *  *,I2>’fIFLA6 

2888*  ELSE 

2898*  IFLA6*-2 

2988*  END  IF 

2918*  388  CONTINUE 

2928*  CALL  SETPLT<0UT,51,5,PLTVEC) 

2938*  PRINT*, ’< - ENTER  TITLE  FOR  PLOT - 

2948*  PRINT* 

2958*  READ!*,’ (AI’ITITLE 

2968*  CALL  PLQTLPIPLTVEC, 51,4, 1, 1, 8.TITLE) 

2978*  528  PRINT*,’NORE  TINE  RESPONSE  RUNS  HITH  THIS  MODEL?  Y/N:  ’ 

2988*  READ!*,’ (A)’)ANSN 

2998*  IFIANSN.NE.’Y’.AND.ANSN.NE.’N’)  60  TO  528 

3888*  IF(ANSH.EQ.'Y’)  60  TO  152 

3818*  525  PRINT*, ’CHAN6E  MATRICES?  Y/N:  ’ 

3828*  READ!*,’ (A)’IANSN 

3838*  IFIANSN.NE.’Y’.AND.ANSN.NE.’N’)  60  TO  525 

3848*  IF(ANSN.Efl.’Y’l  60  TO  142 

3858*  538  PRINT*, ’NORE  RUNS  HITH  MEM  MODEL?  Y/N:  ’ 

3868*  READ!*,’ (Al’)ANSH 

3878*  IFIANSH.NE.’Y’.AND.ANSH.NE.’N’)  60  TO  538 

3888*  IFIANSN.EQ.’YM  60  TO  28 

3898*  ENDFILE14) 

3188*  REMIND44) 

3118*  HOSE  (4) 

3128*  END 

3138*C 

3148*C  END  PR06RAN  ODEACT  - 

3158*C 

3168-C 

3178*  SUBROUTINE  F4(T,I,DX) 

3188*C 

3198«C»**»*********************************«**************»*****«********** 

3288*C 

3218*C  THIS  IS  THE  SET  OF  FIRST  ORDER  ODE  THAT  DEFINE  THE  FOUR-STATE 
322D*C  ACTUATOR  HODEL.  RATE  AND  POSITION  LIMITS  INCLUDED  IF  HFLA6*1. 

3238*C 

J248SC********************************************************************* 

3258*C 

3268*  REAL  T,X(11) ,DX<il) 

3278*  COHNON/NATRII/A  <3, 1 1 1 ,C(4, 1 1 1 , KI (2, 1 1 ), KZ (2, 41 , KIN(2, 4) , 

3288*  1  KXU(2,4),PHI(4,4),PHINT(4,4),CR(4,4) 

3298*  COMNON/CONTRL/UNEH (2) , UOLD  <  2) , UCHD (4) , UCOLD ( 4) , TOLD  1 1 1 ) , 

3388*  1  MOLD  ( 4) ,  IN  (4) ,  HFLA6 

3318*  DXm*A(l,3)«X(3) 

3328*  DX(2)*A(2, 1)*X(1)*A(2,2)*I(2)*A(2,3)*X(3)*A(2,4)*I(4)*A(2,8)*X(8) 

3338*  DX  (3)*A<3,2)  *X  (2)-*A(3,3)*X(3)+A(3, 4)  *X  (4)  -*A(3,8)  *X  (8) 


3349s  DX(4)SX(5) 

335#*  DX (5) =X (6) 

3360s  DX(6)*X<7) 

3370s  DX  <7)*-14911329. 1*X (4>-1148576. 7*X (5) -25364. 42*X (6) -270. 1*X  <7) 

3380s  1  +14911329.  l+UNENU) 

3390s  DX  48)SX (9) 

3400s  DX(9)SX(10) 

3410s  DX(10)SX(11) 

3420s  DX(ll)*-14911329. 1»X(8)-1148576.7*X (91-25364. 42*X (10) 

3430s  1  -270. 1*X( 11) +14911329. 1*UNEN(2) 

3440s  IF4HFLAfi.EB.il  THEN 

3450s  IF (X(4) .6E.2S.0. AND. DX (4) .6T.0.0)  DX(4)=0.0 

3460s  IF(X (4). LE. -25.0. AND.DX (4). LT.0.0)  OX(4)S0.0 

3470s  IF(X(S).6£.60.0.AND.DX(5).6T.0.0)  DX(5)*0.0 

3480s  IF4X 45) .LE. -60.0. AND. DX 45) .LT. 0.0)  DX(5)S0.0 

3490s  IF(X(8).6E.20.0.AND.DX(8).6T.0.0)  DXI8)S0.0 

3500s  IF 4X  481 .LE. -23.0. AND.DX (81 .LT.0.0)  DX(8)S0.0 

3510s  IF(X(9),6E. 52.0. AND. 0X(9).6T. 0.0)  DX(9)S0.0 

3520=  1F(X(9).LE. -52.0. AND.DX (9). LT.0.0)  DX49)S0.0 

3530s  END  IF 

3540s  RETURN 

3550s  END 

3560=C 

3570=C  END  SUBROUTINE  F4  - 

3580*C 

3590«C 

3600s  SUBROUTINE  F3(T,X,DX) 

36I0»C 

3620sC+++++++++++++++++*+++++++++++++++++++++++++++++++++++++++++++++++++++ 

3630*C 

3640*0  THIS  IS  THE  SET  OF  FIRST  ORDER  ODE  THAT  DEFINES  THE  THREE-STATE 
36S0=C  ACTUATOR  MODEL.  RATE  AND  POSITION  LIMITS  ARE  INCLUDED  IF  NFLA6*1. 
3660*0 

3670*C»******»*+»*********+»**»++**+*******»+*»+**+»++ HHWHHHHHHH 

3680*C 

3690*  REAL  T,X(11),DX(U) 

3700*  C0H)fflN/NATRIX/A(3,ll),C(4,ll),KX(2llt>,KZ(2,4>,KXN(2,4), 

3710=  1  KXU(2,4),PHI(4,4),PHINT(4,4),CM(4,4) 

3720*  COHMON/CONTRL/UNEN  (2) ,  UXD(2) ,  UCHD44)  ,UC0LD(4> ,  XOLDI 1 1 1 , 

3730*  1  XH0LD(4),XM(4)fHFLA6 

3740*  0X(l)*A(l,3)+X(3) 

3750*  DX(2)SA<2,1)*X<1)+A(2,2)*X(2)+A(2,3)»X(3)+A(2,4)*XI4)+A(2,8)*X(8) 

3760*  DX(3)sA(3,2)*X(2)+A(3f3)*X(3)+A(3,4)*X(4)+A(3,8)«X(8) 

3770*  DX  44)«X45) 

3780*  DX(5)*X(6) 

3790*  DX (6)*-102978. 792+X (4) -7220. 98*X (5)-125. 3»X (6) 

3800*  1  +102978. 792+UNEN41) 

3810*  DX(7)*0.0 

3820*  DX (8) *X (9) 

3830*  DX(9)*X(10> 

3840*  DX ( 10)*-102978. 792*X (8) -7220. 9B*X (9) -125. 3+X ( 10) 

3850*  1  +102978. 792+UNEN (2) 

3860*  DX(11)«0.0 

3870*  IF(MFLA6.E8.1)  THEN 


3881s  IF (X (4> .6E.2S. 0. AMD.DX (4) .6T. §.0)  0X141*0.0 

3891=  IF<X (4) . LE. -25. «. ANO.OX (4) .LT.0. f )  DX(4)*0.0 

3918=  IF(X(5).6E.60,0.AND.DX(5).8T.0.0)  0X151=0.0 

3911=  IF(X(5).LE.-60.0.AND.DX(5).LT.0.0>  DI(S)=#.0 

3928=  IF(X<8>.6£.29. 0. ANO.OX 48) . 6T. 0. 0)  0X181*0.0 

3930=  IF (X (8) .LE. -23.0. AMD. DX (8> .LT .9. 0)  DX(8)=0.0 

3940=  IF  (X 19) .  6E.  52. 0.  AND.  DX  19) . 6T. 0. 0)  DX19)=0.0 

3930=  IF(X(9).LE.-52.0.AND.DX(9).LT.0.0)  0X191=0.0 

3960*  END  IF 

3970*  RETURN 

3980=  END 

3990=C 

4000=C  END  SUBROUTINE  F3  - 

4010=C 

4020*C 

4030=  SUBROUTINE  FI (T,X,DX) 

4040=C 

4060=0 

4070=0  THIS  IS  THE  SET  OF  FIRST  ORDER  ODE  THAT  DEFINES  THE  SIN6LE-STATE 
4080*0  ACTUATOR  MODEL.  POSITION  AND  RATE  LIMITS  ARE  INCLUDED  IF  NFLA6*1. 
4090*0 

4110*0 

4120*  REAL  T.Klll.DXdl) 

4130=  C0HN0N/NATRIX/A(3,ll),C<4>il),KX(2,U),KZ(2l4)lKXN(2,4)l 

4140=  1  KXU(2,4),PHI(4,4),PH1NT(4,4),CM(4,4) 

4130=  COHHON/C8NrRL/UNEN12),UQU)<2)tUCMD14),UC0LD14>,Z0LDlli>, 

4160=  1  XH0LD<4),XH14),MFLA6 

4170*  DX(l)»A(l,3)tX(3) 

4180*  DXI2)*A(2, 1)»X(1)+A(2,2)*X(2)+A12,3)»I13)+A12,4)*X14)+A(2,8)*X(8> 

4190*  DX(3)*A(3>2)*X(2)«A(3t3)«X(3)HM3,4)tX(4)+A(3l8)iX(8) 

4200*  DX14)*-20.»X(4)*20.0«UNEN(1) 

4210*  0X131*0.0 

4220*  0X161*0.0 

4230=  0X171*0.0 

4240=  DX<8)*-20.*X(8)*20.0*UNEN<2) 

4230*  0X191*0.0 

4260*  0X1101*0.0 

4270*  0X1111=0.0 

4280*  IF 1NFLA6.E8.1)  THEN 

4290*  IF(X(4).6E.23.0.AND.DX(4).6T.0.0)  0X141*0.0 

4300*  IF(X(4).LE.-23.f.AND.DX(4).LT.0.0)  0X141*0.0 

4310*  IF(OX(4).6T.60.0)  0X141*60.0 

4320*  IF (DX141.LT. -60.0)  0X14) *-60.0 

4330*  IF(X(8).SE.20.0.AMD.DX(8).6T.0.f)  0X181=0.0 

4340=  IF1X (8). LE. -23.1. AND. 0X181. LT.0.0)  0X181*0.0 

4330*  IF (OX (8). 6T. 52.0)  0X181*52.0 

4360*  IFIDXISl.LT. -52. 01  DX(8>*-32.0 

4370*  END  IF 

4380*  RETURN 

4390*  END 

4400*0 

4410*0  END  SUBROUTINE  FI  - 


C— 1 9 


SUBROUTINE  6CSTAR<XrNFLAG> 


4459*C 

4479*C 

4489*C  SUBROUTINE  TO  CALCULATE  THE  CONTROLS  AT  EACH  SAMPLE  TINE. 

4499*C  ANTI-NINDUP  COMPENSATED  IF  NFLA6*1. 

43ffaC 

432I=C 

4S3f>  REAL  1(11), DELHI), DEL2(li) 

4541*  INTEGER  NFLA6 

4SS0*  COHHON/NATRI X/A (3, 1 1 ) ,C (4, 1 1 ) , KX (2, 1 1 ) , KZ (2, 4) , KXN (2, 4) , 

4561*  1  KXU(2,4),PHI(4,4),PHINT(4,4),CN(4,4) 

457f*  COHHON/CONTRL/UNEM (2) ,  UOLD (2) , UCHD (4) , UCOLD ( 4 ) , XOLD ( 1 1 ) , 

458#*  1  XH0L0(4),XN(4),MFLA6 

459f*  CALL  MATML (PHI , XMOLD, XM, 4, 4, 1 ) 

4699*  CALL  NATML(PH1NT,UCMD,DEL,4,4,1) 

4611*  CALL  HATAD(XM,0EL,XH,4,t) 

4629*  CALL  HATSBlX, XOLD, DEL,  11,1) 

4639*  CALL  MATML(KX,DEL,DEL2,2,11,1) 

4649*  CALL  HATSB<UOLD,D£L2,UNEN,2,l) 

4659*  CALL  HATSBtXN, XMOLD, DEL, 4,1) 

4669*  CALL  NATNL(KXH,DEL,DEL2,2,4,1) 

4679*  CALL  MATAD(UNEH,DEL2,UNEN, 2,1) 

4689*  CALL  NATSBHICNO, UCOLD, DEL, 4,1) 

4699*  CALL  MATHL<KXU,0EL,DEL2,2,4,1) 

4799*  CALL  HATAD (UNEH, DEL2, UNEW, 2,1) 

4719*  CALL  NATHL(CH,XM0LD,DEL,4,4,1> 

4729*  CALL  MATML (C, XOLD, DEL2, 4, 11,1) 

4739*  CALL  HATSB(DEL,DEL2,DEL,4,t) 

4749*  CALL  NATHL(KZ,DEL,DEL2,2,4,1) 

4759*  CALL  NATAD(UNEN,DEL2,UNEH,2,1) 

4769*  IFINFLA6.E0.1)  THEN 

4779*  IF (UNEHU ) .6T. 75.9-2. (4) )  UNEM(1)*75.9-2.9«X(4> 

4789*  IF(UNEH(1). LT. -75.9-2. 9*X(4))  UNEN(l)*-75.9-2.9*X(4) 

4799*  IF <UNEN (2) . 6T. 69. 9-2.9*X (8) )  UNEN(2)*69.9-2.9tX(B) 

4899*  !F(UN£N(2).LT.-69.9-2.9*X(8))  UNEN(2)*-69.#-2.9*X(8) 

4819*  IF(UNENd).GT.3.6*X<4»  UNEN(1)*3.6*X(4) 

4829*  IF <UNEM( 1) .LT.-3.6+X (4) )  UMEN(l)*-3.6+X(4) 

4839*  IF(UNEH(2).6T.3.12+X(8>>  UN£N(2)*3.12+X(8) 

4849*  IF (UNEU(2) .LT.-3.12+XO))  UNEN(2)*-3.12+X(8) 

4859*  END  IF 

4869*  RETURN 

4879*  END 

4B89*C 

4899*C  END  SUBROUTINE  8CSTAR  - 

4999-C 

4919*C 

4929*  SUBROUTINE  RPOUT(A,H,N) 

4939-C 

4959*C 


4964*0  THIS  ROUTINE  PRINTS  OUT  A  REAL  MATRIX  A 
4974*0 

4994*0 

5444=  REAL  A(M,N) 

5414*  INTEGER  I,J,N,N 

5424*  DO  2#f  1*1,11 

3131s  PRINT’ C  *fS(Ell.4,3I)>*y (A(ItJ)tJ>I,N) 

3141s  PRINT* 

5134s  244  CONTINUE 
3464s  END 

5474*0 

5484SC  END  SUBROUTINE  RPOUT  - 

3494*C 

3144*0 

3114s  SUBROUTINE  £TPLT(A,N,H,X) 

5124*0 

5144*0 

3134*0  THIS  ROUTINE  CONVERTS  A  REAL  MATRIX  OF  DIMENSION  N  BY  H  INTO  A 
5164*0  VECTOR  THAT  IS  COMPATIBLE  NITH  R.H.  FLOYD’S  PRINTER  PLOTTING 
5174*0  ROUTINE,  PLOTLP.  THE  INPUT  MATRIX  IS  A. 

5184*0  N*  RON  DIMENSION  OF  A,  THE  NUMBER  OF  POINTS  TO  BE  PLOTTED 
3194*0  H*  COLUMN  DIMENSION  OF  A,  THE  NUMBER  OF  FUNCTIONS  TO  BE  PLOTTED  *1 
5244*0  X*  THE  PLOTTING  VECTOR,  DIMENSION  N»H 
5214*0 

S224*C********************************************************************* 

5234*0 

5244*  REAL  A(N,M),X(N*M) 

3234*  INTEGER  N,H,I,J 

5264*  DO  144  J*l,H 

5274s  DO  IN  1*1, N 

5284*  X(I+(J-1)«N)*A(I,J) 

3294*  144  CONTINUE 
5344*  END 

5314*0 

5324*0  END  SUBROUTINE  SETPLT  - 

5334*0 

5344*0 

5334*  SUBROUTINE  PLOTLP (A, N, M, IPSO, ISCL, LPTERR, TITLE) 

3364*0 

3384*0 

5394*0  THIS  ROUTINE  NAS  ADAPTED  FROM  R.H.  FLOYD’S  THESIS  TO  PRODUCE 
3444*0  PRINTER  PLOTS  OF  COMPUTED  RESULTS. 

5414*0  A*  VECTOR  OF  DATA,  CONVERTED  FROM  MATRIX  FORM  BY  SUBROUTINE  SETPLT 
3424*0  N*  NUMBER  OF  POINTS  (INDEPENDENT  VARIABLE)  TO  BE  PLOTTED 
5434*0  H*  NUMBER  OF  FUNCTIONS  (DEPENDENT  VARIABLES)  TO  BE  PLOTTED 
5444*0  IPSO  *  -1 — >ALL  VARIABLES  SCALED  T06ETHER  (1  PLOT) 

5434*0  *  4 — >SCAL£D  TOGETHER  AND  SEPARATELY  (2  PLOTS) 

3464*0  *  +1 — >SCALED  SEPARATELY  (1  PLOT) 

5474*0  ISCL  *  4 — >PLOT  OVER  EXACT  RANGE  OF  VARIABLE 
3484*0  *■! — >PLOT  NITH  EVEN  SCALIN6 

3494*0  LPTERM  *  4-->PL0T  54  CHARACTERS  HIDE 


y/tvv 


55ff*C  +1 — >PLOT  iff  CHARACTERS  HIDE 

551f»C  TITLE  *  HAX  OF  5f  CHARACTERS,  TYPE  CHARACTER 
552f*C 

S33H>«hhhhhhhhhhhhhhhhhihh<hhhhhihh({hihhh 

534f*C 

555#*  REAL  YSCAL(A),YHlN(4),YPRUi),RlSPAC,RNIN,RRAX,YL,YH,XPR,A(*> 

554fa  REAL  SCAL 

357 f*  INTEGER  IBLMK (6) , IPSCf ISCLf LPTERK, IPAPER, ISPAG, IPRTI, ISC, J, IC, IX 

558f*  INTEGER  ILt JPf  ITEItf»tHl,N2,Nf Nf  ICO, I 
559f*  CHARACTER  TITLE*5f 

5iff*  CHARACTER*!  BLANK, PLUS, COLON, GRID, SYMBOL ( A) , OUT ( if 1 ) 

54 If*  DATA  BLANK, PLUS, COLON, SYMBOL (i),SYNBOL (2)/’  ’♦,,,:',,r,’27 

542f»  DATA  SYMBOL (3> , SYMBOL (4) t SYMBOL (5> , SYMBOL (&> / ’ 3* , ’ 4' , ’ 5* , ’ 6 V 
5A3f*  I PAPER'S* (1+LPTERM) 

564#-  ISPAC=lf»IPAPER 

565#*  RISPAC*REAL( ISPAC) 

566#*  ISPAC*ISPAC*1 

567f*  IPRTI*IPAP£R*1 

568#*  RHIN*A(N*1) 

569f*  RHAX-RMIN 

57##*  25  DO  41  1SC*1,H 

571f*  H1«ISC*N*1 

572f*  YL*A(M1) 

573#*  YH*YL 

574#=  H2«N*(ISC*1) 

573f*  DO  4f  J*M1 ,M2 

576#*  IF (A  t J) . LT. YL) THEN 

577#*  Yl«A<J) 

578f*  END  IF 

579#*  IF(A(J).6T.YH)THEN 

58##*  YH-A(J) 

SSI#*  END  IF 

582f*  4#  CONTINUE 

383#*  IFIYL.LT.RMINiTHEN 

584f*  RMIM-YL 

SSSf*  END  IF 

S86f*  IF<YH.6T.RMAX) THEN 

587f*  RHAX-YH 

588#*  END  IF 

589#-  IF(IPSC.6E.f)THEN 

59f#»  CALL  VARSCLI YL, YH, YSCAL (ISC) ,RISPAC,ISCL) 

591f-  END  IF 

592#-  YM1M<  ISO-YL 

593f*  41  CONTINUE 

594f-  IF(IPSC.LE.f)  THEN 

395#-  CALL  VARSCL(RHIN,RMAX, SCAL, RISPAC, ISCL> 

596#*  END  IF 

597#-  IC-2-IABS ( IPSC) 

398#*  00  42  IX*1,ISPAC 

599f«  OUT  < IX)*BLAMK 

6fff*  42  CONTINUE 

if if-  DO  iff,ICO>l,IC 

6#2f*  PRINT’  Cl*,  1U,  A5f»\ TITLE 

6f 3#-  HRITEI4,’ ( i 1 X , A5f ) ’ ) TITLE 


C-22 


6#4#= 
6#5#* 
t>«69= 
607*> 
6#8#- 
619#* 
61##* 
611#* 
612#* 
613f* 
614#* 
613#*  44 
616#* 
617#* 
618#*  46 
619#* 
62##* 
621#* 
622#* 
623#* 
624#* 
625#* 
626#* 
627#* 
628#* 
629#* 
63##* 
631#* 
632#* 
633#=  5# 
634#* 
633#*  S3 
636#* 
637#* 
638#* 
639#* 
64##* 
641#*  59 
642#-  6# 
643#* 
644#* 
643#* 
646#* 
647#* 
648#*  7# 
649#* 
63M* 
631#* 
652#* 
653f> 
654#* 
653#* 
636#* 
657#* 


HRITE(4,’(A1)’)BLANK 

PRINT* 

DO  6#  1*1,  N 
XPR*A ( I ) 

IF (HOD ( I , If ) . EB. 0) THEM 
6RID*C0L0N 
ELSE 

6RID*BLANK 
END  IF 

DO  44  IX*2,ISPAC,2 
0UT(IX)*6R1D 
CONTINUE 

DO  46  IX*1,ISPAC,1# 

OUT(IX)*PLUS 
CONTINUE 
DO  55  3*1,  N 
IL*I*3*N 

IFUPSC.EQ.-DTHEN 
JP*INT((A(IL)-RHIN)/SCAL)+1 
ELSE  1F(IPSC.EQ.#)THEN 
IPSCT*IPSC+ICO 
IF ( IPSCT.EQ.2) THEN 

JP*INT  ( (A(IL)-YHIN(JH  /YSCALIJ)  )*1 
ELSE 

3P*INT(<A(ILHWIN)/SCAL)*1 
END  IF 
ELSE 

JP*1NT((A<IL)-YHIN(JH/YSCALIJ))*1 
END  IF 

0UT(JP)*SYHB0L(3) 

IBLNK(J)*JP 

CONTINUE 

PRINT’ C  a,F11.4,6X,l#lAl)',XPR,(0UT(IX),IX*l,ISPAC) 
NR1TEI4,’  IF11.4,6X,H1A1)’)XPR,  (OUT (ID,  11*1, ISPAC) 

DO  59  J*1,H 
ITENP*IBLNK(J) 

OUT(ITENP) -BLANK 
CONTINUE 
CONTINUE 

IFdPSC.NE.DTHEN 
IF ( IPSCT ■ NE.2) THEM 
YPR(1)*RHIN 
DO  7#  1*1 , IPflPER 

YPRII*1)»YPRU)*1#.*SCAL 

CONTINUE 

PRINT’ (*•  SCALE  •,11E1#.3)’,<YPR(I),I*1,IPRTI) 
NRITE14,  MAD’)  BLANK 

NRITEI4,’C  SCALE  •,UE1#.3)’HYPR(I),I*1,IPRTI) 
HRITE<4y ’ (Al) ’ >BLANK 
HRITE44, ' (Al) ’ ) BLANK 
END  IF 
END  IF 

IF ( IPSC. EB. 1 .OR. IPSCT.EB. 2>  THEN 
DO  76  ISC-l.n 


638#*  YPRU)»YHIM(1SC) 

639#*  00  74  1*1, IPAPER 

66##*  YPR(  I  ♦!  )*YPR  ( I>  *1#.  a-YSCAL  (ISC) 

661#*  74  CONTINUE 

662#*  PRINT’!*#  SCALE  *,A1, IX, 11E1#.3)’, SYMBOL ( ISC) f 1YPR1II) 

663#*  1,IX*1,IPRTI) 

664#*  NRITE14,*  (ADM  BLANK 

663#*  NRITE(4,’(*  SCALE  ,,A1,1X,11E1#.3)MSYHB0L(ISC), 

666#*  1(YPR(IX),II*1,IPRTI) 

667#*  76  CONTINUE 

66 8#*  ENO  IF 

669#*  00  9#  ISC*1,36-N 

67##*  NRITE<4,’ <A1)M  BLANK 

671#*  9#  CONTINUE 

6728*  1##  CONTINUE 

673#*  PRINT*  Cl*)’ 

674#*  END 

673#*C 

676#=C  END  SUBROUTINE  PLOTLP  - 

677#*C 

678#*C 

679#*  SUBROUTINE  VARSCL ( XHIN, XNAX , SCALE , RSPACE, ISCL) 

68##*C 

682#*C 

683f*C  THIS  IS  A  SCALING  ROUTINE  THAT  SUPPORTS  PLOTLP 

684#*C  ADAPTED  FROM  R.H.  FLOYD'S  THESIS 

683#*C 

687#*C 

688#*  REAL  XHIN, XNAX, SCALE, RSPACE, EXP, XHINT.XHAXT 

689#*  INTEGER  ISCL, ISCAL 

69##*  IF ( XNAX . EB. XHIN) THEN 

691#*  XHIN*.9«XHIN-1#. 

692#*  END  IF 

693#*  SCALE*XHAX-ININ 

694#*  IF(!SCL.NE.#)THEN 

693#*  EXP*INT(lf#.H.06i#(SCALE)  )-!##. 

696#*  FACTOR*l#.»*(l.-£XP> 

697#*  XHINT*XNIN«F ACTOR 

698#*  XHAXT*XNAX«F ACTOR 

699#*  IF(XHAXT.SE.#.)THEN 

7###>  XHAXT«XHAXT*.9 

7 #1#*  END  IF 

7#2#>  IF(XNINT.LE.«.)THEN 

7#3#*  XH!NT*XNINT-.9 

7#4#»  END  IF 

7#3«*  XHINT*AINT(XHINT) 

7#6#>  ISCAL*XNAXT-XHINT 

7#7#»  IF (NODI ISCAL, 3). NE.#> THEN 

7#8#»  ISCAL*ISCAL+3-H0D ( ISCAL, 3) 

7#9#»  END  IF 

71ff*  FACTOR*l#.*« (EXP-1.) 

711#*  XHIN*XHINT#FACTOR 


7121s  SCALE*FACTQR*REAL ( ISCAL) 

7131s  END  IF 

7148s  SCALE*SCALE/RSPACE 

7151s  END 

7168*C 

7178*0  END  SUBROUTINE  VARSCL - 

7188*0 

7198-C 

7288s  SUBROUTINE  EDIT (EDHAT,H, N) 

7218*0 

7228<HHHIHHHH«IHHMHHHHHHHHHHHiH»HIHHHHHHHH 

7238*0 

7248*0  THIS  ROUTINE  ALLCWS  THE  USER  TO  EDIT  AN  N  BY  N  MATRIX  EDHAT 
7258*0 

7278*0 

7288*  REAL  EL, EDHAT (H,N) 

7298*  INTE6ER  M,I,J 

7388*  CHARACTER  ANSH«1 

7318*  18  PRINT*,’ LIST  CURRENT  VALLES?  Y/N:  ’ 

7328*  READY*,*  (AIMANSM 

7338*  IF(ANSN.NE.’Y’.AND.ANSN.NE.’N’)  60  TO  18 

7348*  IF(ANSN.EO.’Y’)  CALL  RPOUT (EDHAT, H,N) 

7358*  PRINT*,’ ENTER  8,8,8  <CR>  NHEN  ALL  CHAN6ES  HAVE  BEEN  HADE’ 

7368*  188  PRINT*, ’ENTER  RON  t,  COLUMN  I,  AND  MATRIX  ELEMENT:  ’ 

7378*  118  READ*, I, J, EL 

7388*  IF(1.GT.8.AN0.1.LE.H.AND.J.6T.8.AND.J.LE.N)THEN 

7398*  EDHAT(I,J)*EL 

7488*  GO  TO  118 

7418*  ELSE  IF ( I.E8.8. ANO. J.EO.O) THEN 

7428*  158  PRINT*, ’LIST  MOBIFIEO  MATRIX?  Y/N:  ’ 

7438*  READ!*,’ (AI’)ANSN 

7448*  IF<ANSM.*.,Y’.AMD.ANSM.NE.’N’>  60  TO  158 

7458*  IFIANSN.Efl.’Y’l  CALL  RPOUT (EDHAT, M,N) 

7468*  288  PRINT*, ’ANY  MORE  CHANGES  TO  THIS  MATRIX?  Y/N:  ' 

7478*  READ(*,’(A)’)ANSM 

7488*  IF(ANSH.NE. '  Y' .  AND.  ANSN.  NE.  'N'  160  TO  288 

7498*  IF(ANSN.EB.’Y’)60  TO  188 

7588*  IF (ANSN. EB. ' N’ ) RETURN 

7518*  ELSE 

7528*  PRINT*, ’SUBSCRIPT  OUT  OF  RANGE’ 

7338*  80  TO  188 

7548*  END  IF 

7358*  END 

7568*C 

7378*0  END  SUBROUTINE  EDIT - 

7588*0 

7598*0 

7688*  SUBROUTINE  HATML(A,B,C,L,H,N) 

7618*0 

7628-C********************************************************************* 

7638*0 

7648*0  THIS  ROUTINE  HILL  MULTIPLY  TMO  REAL  MATRICES 
7658*0  A*AN  L  BY  H  MATRIX 


766#*C  B*AN  II  BY  N  NATRIX 

767#*C  C*THE  L  BY  N  PRODUCT  Of  A  AND  B 

7&8f*C  NOTE:  ACTUAL  AR6UHENT  C  RUST  DIFFER  FROM  A  AND  B 

769#*C 

771#*C 

772#*  REAL  A<L,N),B<H,N),C(L,NJ 
773#*  INTEGER  I,J,K,L,H,N 
7741*  DO  1##  1*1, L 
773#*  DO  1##  J*1,N 

776#*  C(I,J)*#.« 

777#*  1##  CONTINUE 

778#*  DO  2##  1*1, L 

779#*  DO  2##  J*1,N 

78##*  DO  2##  K*1,H 

781#*  C(I,J)*C(I,  J)+A(I,IC)*B(K,  J) 

7821*  2#i  CONTINUE 
783#*  END 
784#=C 

783#=C  END  SUBROUTINE  NATHL  - 

786#*C 

787#*C 

788#*  SUBROUTINE  MTAO(A,B,C,L,N) 

789#*C 

78l»CHIHWHHWWHWHHHWHHHWHIHWH«H«fWHIHHHW 

791#*C 

792#*C  THIS  ROUTINE  ADOS  TNO  REAL  MATRICES  OF  DIMENSION  L  BY  N 

7?3#*C  A  AND  B  ARE  THE  INPUTS,  C  IS  THE  SUN 

794#*C 

796#*C 

797#*  REAL  A(L,R),B(L,N),C(L,H) 

798#*  INTEGER  I,J,L,H 

799#*  DO  1##  1*1, L 

8###*  DO  IN  J*l,H 

8#1#»  C(I,J)*A(I,J)+B(I,J) 

882#*  1##  CONTINUE 
803#-  END 

o  UM*T 

BVTVw 

8#5#*C  END  SUBROUTINE  NATAD  - 

oiiisr 

8171*0 

8#8#»  SUBROUTINE  NATSB(A,B,C,L,N) 

8#9#*C 

lHKnmHWHHHHWHHHH»WWHmWWIWWHWHWWIWWWI 

8U#*C 

81 2#*€  THIS  ROUTINE  SUBTRACTS  REAL  MATRIX  B  FROM  REAL  MATRIX  A 
813#*C  DIFFERENCE  IS  RETURNED  IN  REAL  MATRIX  C. 

814f*C  ALL  THREE  MATRICES  ARE  OF  DIMENSION  L  BY  N 
813#*C 


817#*C 

818#*  REAL  A<L,M),B(L,H),C(L,H) 

819#*  INTE6ER  I,J,L,M 


C-26 


■  •  ■*-  ■  •  -  ■  .  ■  -  "j.  'j  W  ■->  ’-r-r  --  /  V  .  . 


8221*  C<I,J)*AIIfJ)-8U,J) 

8231*  Iff  CONTINUE 
8241*  END 

823f*C 

82A#«C  EM)  SUBROUTINE  HATSB - 

827#*C 

828f*C 

8291*  SUBROUTINE  SHUL<A,B,C,L,H) 

83ff*C 

KIKHmmUtHHHHWHWWWHUlHHHHWHHHWWWWtWHHH 


832f*C 

833f*C  THIS  ROUTINE  HULT1PUES  A  REAL  MATRIX  BY  A  REAL  SCALAR 

834f*C  A*  THE  SCALAR 

833#*C  B*  THE  MATRIX 

836#*C  C*  THE  PRODUCT 

S37«-C  B  AND  C  ARE  OF  DIMENSION  L  BY  N 

838#*C 


84##*C 

841#* 

REAL  A,BM>iC(LfH) 

842#* 

INTESER  I,J,L,N 

843#* 

DO  IN  1*1, L 

844#* 

DO  IN  J*1,M 

845#* 

C(I,J)*A*B(I,J) 

846#*  1## 

CONTINUE 

047#* 

END 

848#*C 

849#*C  END 

SUBROUTINE  SHUL  - 

8S##*C 

8S1#*C 

832#* 

SUBROUTINE  COPYHT (A, B,N,H) 

853#*C 

833#*C 

8S6#*C  THIS  ROUTINE  COPIES  A  REAL  MATRIX  A  INTO  REAL  MATRIX  B. 

837#*C  BOTH  MATRICES  ARE  OF  DIMENSION  N  BY  It. 

858f*C 

86##*C 

861#-  REAL  A(N,H) ,B(Nf H) 

8621*  INTEGER  I,J,N,N 

8631*  DO  IN  I*1|N 

864#*  DO  IN  J*i,H 

865#*  B(I,J)*A(I,J) 

866#*  IN  CONTINUE 
867#*  END 

868#*C 

869(*€  END  SUBROUTINE  COPYHT  - 

B7f#*C 

871#*C 

872#*  SUBROUTINE  DSCRT ( A,  N, TSAHP, PHI , PHINT ,  H,  TP, TIDENT , CNORK) 

873#*C 


875#*C 

8768=C  THIS  ROUTINE  APPROXIMATES  THE  STATE  TRANSITION  MATRIX  AND  ITS 

877f«C  INTEGRAL  FOR  A  TINE  INVARIANT  LINEAR  SYSTEM  AS  A  MATRIX  EXPONENTIAL 

8788=C  (MR  A  SHALL  SAMPLE  PERIOD.  RESULTS  RETURN  IN  REAL  MATRICES. 

8798*C  A=  SYSTEM  DYNAMICS  MATRIX,  TYPE  REAL 

8888*C  N>  STATE  D1HENS10N 

881NC  TSAHP*  SAMPLING  PERIOD 

8828-C  PHI*  STATE  TRANSITION  MATRIX,  TYPE  REAL 

883I*C  PHINT*  APPROXIMATE  INTEGRAL  OF  PHI,  TYPE  REAL 

884#*C  H*  NUMBER  OF  TERNS  USED  IN  EXPONENTIAL  EXPANSION 

8858*C  TP,  TIDENT  AND  CMORK  ARE  DUHHY  ARRAYS 

B868-C 

888f*C 

8898=  REAL  A(N,N) , PHINT (N,N) ,PHI (N,  N> , TIDENT (N,N) , TP (N, N) 

8988*  REAL  CHORKIN, N) 

8918*  REAL  TSANP, RIJ 
8921*  INTESER  I,J,N,N 
8938*  DO  2ff  1*1, N 
8941*  DO  1M  J*1,N 

8958*  TIDENT  < I, J)=#.f 

8968*  188  CONTINUE 

8978*  TI0ENT(I,1)*1.8 

8988*  288  CONTINUE 

8998*  CALL  SMUL4TSAHP, TIDENT, PHINT, N,N> 

9888*  CALL  COPYNT  4PHINT, TP, N, N> 

9818*  CALL  SNUL(TSAMP,A,PHI,N,N) 

9828*  DO  388  1*1, N 

9838*  CALL  HATHL(TP,PHI,CHORK,N,N,N) 

9848*  CALL  COPYNT(CWRK,TP,N,N) 

9858*  RIJ*1. 8/REAL (I+l) 

9868*  CALL  SHUL(RIJ,TP,TP,N,N> 

9878*  CALL  HAT  AD4PHINT, TP, PHINT, N, N) 

9888*  388  CONTINUE 

9898*  CALL  HATH  (A,  PHINT,  TP,  N,  N,  N) 

9188-  CALL  HATAO<TIDENT,TP,PHI,N,N) 

9118*C 

9128-C  END  SUBROUTINE  DSCRT  - 

9138*C 


D.  Modified  CGT/PI/KF  Design  Software 

D.1  Introduction 

This  appendix  discusses  the  CGT/PI/KF  design  software  that  was 
used  in  this  study.  The  program  was  originally  written  by  Capt  R.  M. 
Floyd  [16].  It  was  modified  by  Lt  A.  Moseley  [34]  to  provide  an 
interface  with  additional  performance  evaluation  software  and  to 
incorporate  the  ability  to  use  implicit  model-following.  Further 
modifications  were  made  prior  to  and  during  this  study  to  enhance  the 
implicit  model-following  design  capability,  and  to  Incorporate  a  minor 
correction  to  the  original  code  that  was  suggested  by  Capt  Floyd  [17]. 
The  resulting  version  has  been  referred  to  in  this  thesis  as  CGTPIV. 

The  need  for  an  additional  correction  to  the  code  was  discovered  after 
the  design  work  of  this  study  had  been  completed  [17].  Appendix  E 
fully  documents  that  error,  how  it  was  corrected,  and  its  impact  on  the 
results  of  this  study.  That  correction  has  been  added,  for  complete¬ 
ness,  to  the  source  listing  in  Section  D.4. 

Extensive  programming  and  usage  guides  for  the  earlier  Floyd  and 
Moseley  versions  of  the  program  were  provided  in  [16,34]:  specifically. 
Volume  2  of  each.  Since  familiarity  with  these  works  is  really  a 
prerequisite  for  intelligent  use  of  the  software,  the  Information 
therein  is  not  repeated  here.  Only  changes  made  for  this  study  are 
covered  in  this  appendix. 

D.2  Program  Changes 


All  of  the  changes  made  to  the  original  program  written  by  Capt 
Floyd  [16]  are  annotated  on  the  source  listing  in  Section  D.4.  The 


first  correction  suggested  by  Capt  Floyd  [17]  is  enclosed  in  a 
dashed-line  box,  and  includes  lines  9970  through  10010.  The  correction 
deals  with  choice  of  matrix  manipulation  routines  which  could,  in  some 
circumstances,  affect  the  correct  development  of  the  cross-weighting 
terms  of  the  discrete-time  state  weighting  matrix  for  the  regulator. 

The  second  correction  suggested  by  Capt  Floyd  is  similarly  annotated  at 
lines  10435  and  10440,  and  is  explained  in  Appendix  E.  The  rest  of  the 
dashed-line  boxes  throughout  the  listing  are  changes  made  by  Lt 
Moseley,  not  all  of  which  were  documented  in  his  thesis  [34].  The 
section  of  code  starting  at  line  27050,  and  proceeding  through  the  end 
of  the  listing,  was  added  by  Lt  Moseley. 

The  rest  of  the  changes  to  the  original  code  were  made  as  a  result 
of  this  thesis  effort,  and  are  annotated  on  the  listing  by  solid-line 
boxes.  In  the  version  of  the  program  developed  by  Lt  Moseley,  implicit 
model-following  could  only  be  used  in  regulator  design  immediately 
after  the  step  during  which  a  CGT  was  designed.  There  was  apparently 
no  reason  for  this  other  than  expediency  in  ensuring  that  implicit 
model-following  was  not  attempted  without  a  command  model  having  been 
established.  The  changes  marked  at  line  3810,  3930-4080,  4860,  4890, 
6450,  6580,  8790,  9060,  9320,  9460-9480,  10970  and  28170,  as  well  as 
the  deletions  in  subroutines  "SCMD"  and  "IMPLEX"  were  all  made  to 
remove  this  restriction.  The  "IMPLIC"  flag  is  initialized  in  line  3810 
to  indicate  that  implicit  model-following  has  not  yet  been  selected  for 
the  current  design  run.  Once  the  regulator  design  option  is  selected, 
the  code  at  line  3930  offers  the  implicit  model-following  option. 
Acceptance  of  the  option  sets  "IMPLIC"  to  1  and  branches  to  subroutine 
"SETUP"  to  allow  the  definition  or  redefinition  of  the  command  model 


for  use  as  the  implicit  regulator  command  model.  The  changes  to 
"SETUP"  at  lines  4860  and  4890  allow  for  a  value  of  4  for  the  flag 
"ITYPE",  which  is  used  to  tell  subroutine  "SCMD"  that  changes  to  the 
command  model  are  to  be  made,  but  that  a  CGT  design  is  not  being 
pursued,  as  shown  at  lines  6450  and  6580.  Initialization  of  the 
"NEWCM"  flag,  for  which  a  value  of  1  signifies  a  change  to  the  command 
model,  has  been  moved  from  SCMD  to  line  10970  to  ensure  that  subsequent 
CGT  designs  implement  the  most  recently  defined  command  model.  The 
changes  at  lines  8790,  9060  and  9320  add  "IMPLIC"  as  a  calling  argument 
to  the  regulator  design  subroutines.  The  changes  at  line  9460  ensure 
that  "IMPLEX"  is  only  called  when  implicit  model-following  is  being 
pursued,  since  the  function  that  it  would  have  performed  under  other 
circumstances  is  now  being  performed  at  line  3930;  for  the  same  reason, 
"IMPLIC"  has  been  removed  as  a  calling  argument  at  line  28170,  and  the 
previously  mentioned  deletions  to  "IMPLEX"  made. 

The  changes  in  subroutine  "RSYS"  (changes  at  lines  21520  and 
21690-21700  as  well  as  the  deletion)  correct  a  rather  serious  error  in 
the  implicit  model-following  code.  Without  the  corrections,  a  change 
to  the  command  model  dynamics  matrix  or  design  model  control  matrix 
could  only  affect  the  variables  used  to  calculate  the  implicit 

A  A  A 

regulator  weighting  matrices,  ,S^  and  R^  of  (A-45),  if  the  model 
that  was  changed  had  not  previously  been  written  to  the  SAVE  file.  In 
CGTPIV,  all  model  dynamics  and  control  matrices  are  discretized 
immediately  after  they  are  defined,  and  the  continuous-time  matrices 
are  overwritten  to  save  storage  space.  Development  of  the  implicit 
state  weighting  matrix  through  (A-45)  requires  the  use  of  the  command 
model  dynamics  matrix  and  the  continuous-time  design  model  control 


matrix.  When  the  program  was  modified  to  incorporate  implicit 
model-following,  storage  for  these  matrices  was  allocated,  but  the 
program  steps  which  altered  the  values  in  the  arrays  after  model 
redefinition  were  bypassed  if  the  model  that  had  been  redefined  had 
already  been  written  to  the  SAVE  file  during  the  current  program  run. 
When  the  required  steps  were  bypassed,  no  indication  was  given  the  user 
that  the  changes  had  not  had  an  effect  on  the  regulator  design,  other 
than  getting  the  wrong  answer. 

The  changes  at  lines  28760-28870  simply  allow  the  user  to  review 

A 

the  matrix  after  the  implicit  quadratic  weights  (Qj  and  matrices) 
have  been  entered.  In  case  the  distribution  of  state  weights  is  not 
what  the  designer  wants,  the  option  to  change  the  and  R^  matrices  is 
offered  prior  to  completing  the  regulator  design. 

An  interactively  executable  load  module  for  CGTPIV  can  be  achieved 
using  the  segmentation  Job  control  file  listed  in  Section  D.5.  With 
the  changes  made  for  this  study,  the  program  requires  just  over  65,000 
octal  words  of  memory  for  execution. 

D.3  Using  the  Modified  Software 

Preparation  for  executing  CGTPIV  is  exactly  as  outlined  in  the 
instructions  of  [16,3^].  The  only  change  as  far  as  the  user  is 
concerned  is  that  more  design  flexibility  is  available  during  execu¬ 
tion.  The  modified  code  allows  the  user  to  employ  implicit 
model-following  for  all  regulator  designs  without  requiring  that  a  CGT 
design  be  conducted.  An  implicit  model-following  regulator  can  thus  be 
designed  by  iteratively  changing  either  the  quadratic  weightings  or  the 
regulator  command  model,  or  both.  There  is  still  only  one  "command 


model"  in  memory  at  any  given  time.  During  the  CGT  design  and 
evaluation  process,  it  functions  as  a  CGT  command  model.  During 
regulator  designs,  it  functions  as  a  regulator  command  model.  Since 
the  regulator  design  model  is  only  used  to  define  the  constant  gains 
for  the  regulator,  the  functions  are  distinct.  At  each  entry  into  the 
CGT  or  implicit  model-following  regulator  design  path,  the  option  is 
offered  to  change  the  command  model,  so  the  models  used  for  the  two 
design  functions  need  not  be  the  same. 

A  sample  execution  of  the  program  follows.  The  load  module  is  the 
file  CGTPIV.  The  DATA  file  contains  the  design  model  for  the  AFTI  F— 1 6 
used  in  this  study,  and  a  two-state  command  model,  as  in  (V-4)  through 
( V— 6) ,  in  which  P  =  5.  The  sample  is  short,  showing  only  the  ways  in 
which  CGTPIV  differs  from  previous  versions.  The  software  correction 
in  lines  10435  and  10440,  documented  in  Appendix  E,  was  incorporated 
prior  to  the  sample  run,  so  the  results  are  correct. 


COWHAND-  attach, d52dat 


PFM  IS 
DS2DAT 

AT  CY*  Ml  SN*AFIT 

COWHAND-  copy, dS2dat, data 

COWHAND-  attach, cqtpiv 

PFN  IS 
C6TPIV 

AT  CY*  Ml  SN*AFIT 
COWHAND-  cgtpiv 


a  »  #  C8TPIF  a  a  * 

PR08RAH  TO  DESIGN  A  COWHAND  GENERATOR  TRACKER 
USING  A  REGULATOR  WITH  PROPORTIONAL  PLUS  INTEGRAL  CONTROL 
AND  A  XALHAN  FILTER  FOR  STATE  ESTIWATION. 
a  a  a  C6TPIF  a  a  a 


DATE  1  11/12/83 
TIHE  I  14.59. 57. 


ENTER  SAHPLE  PERIOD  FOR  DIGITAL  CONTROLLER  >.12 
READ  DESIGN  HODEL  FROH  ’DATA’  FILE  <Y  OR  N)  >y 
MODIFY  MATRIX  ELEHENTS  (Y  OR  N)  >n 
WRITE  DESI6N  HODEL  TO  ’SAVE’  FILE  (Y  OR  N)  >n 
POLES  OF  DESI6N  MATRIX 


1.3444988E-I3  aj(  I.  ) 

1.297I761E+M  *J(  f.  > 

-J.44A4228E+M  aj(  f.  ) 

-2.MMMfE*«i  *J<  i.  > 

-2.MMMGE+G1  aj(  f.  ) 


CONTROLLER  DESIGN  (Y  OR  N)  >y 
DESIGN  RES/PI  (Y  OR  N)  >y 
INCORPORATE  IMPLICIT  HODEL  (Y  OR  N)  >y 
READ  COWHAND  HODEL  FROH  ’DATA'  FILE  <Y  OR  N>  >y 


MODIFY  MATRIX  ELEHENTS  (Y  OR  N)  >n 


MITE  COMMAND  MODEL  TO  ’SAVE’  FILE  (¥  OR  N)  >n 

POLES  OF  COMMAND  MATRIX 

-5.0000000E+00  *J(  t.  ) 

-5.0000000E+00  +JI  f.  ) 

ENTER  HEIGHTS  ON  IMPLICIT  OUTPUT  DERIVATIVES:  2 
ENTER  I  AND  8N<I,I)~<0/  WHEN  COMPLETE)  >1,1 
2,1 

1/ 

ENTER  MEIBHTS  ON  IMPLICIT  CONTROL  MAGNITUDES:  2 
ENTER  I  AND  8N(I,l)--I0/  WHEN  COMPLETE)  >1,1 
2,1 

91 

LIST  OIH  MATRIX  TO  TERMINAL  (Y  OR  N)  >y 
QIH  MATRIX 


S0.01 

-16.31 

3.030 

.8952 

1.473 

-16.30 

10.89 

-1.9800E-02 

-.5907 

-.9733 

3.030 

-1.9800E-02 

1.000 

1.0740E-03 

1.7700E-03 

.8932 

-.5907 

1.0740E-03 

3.2041E-02 

5.2803E-02 

1.473 

-.9735 

1.7700E-03 

5.2805E-02 

8.7023E-02 

CHAN6E  IMPLICIT  HEIGHTS  (Y  OR  N)  >n 


SI  MATRIX 

1.000 

1.000 

RI  MATRIX 

1.000 

1.000 

ENTER  HEIGHTS  ON  OUTPUT  DEVIATIONS:  2 
ENTER  1  AND  MMI, !)-(«/  WHEN  COMPLETE)  >91 

ENTER  HEI6HTS  ON  CONTROL  MAGNITUDES:  2 
ENTER  I  AND  ONU,I)~<0/  NHEN  COMPLETE)  >0/ 

ENTER  NEI6HTS  ON  CONTROL  RATES:  2 

ENTER  I  AND  <•/  NHEN  COMPLETE)  >1,10 

2,10 


Y  MATRIX 


». 

I. 

utf  nmu 

i. 

«. 

MODIFY  ELEMENTS  OF  T  MATRIX  (Y  ON  N)  >n 

UR  MATRIX 

lf.M 

ll.ff 

KI  MATRIX 

-34.85  14.54  -1.956  1.429  .1587 

53.58  -57.87  .1482  .1515  .7372 

KZ  MATRIX 

-.8226  -.7776 

-2.147  2.221 

CONTROLLER  EVALUATION  NRT  TRUTH  MODEL  (Y  OR  N)  >n 

POLES  OF  RE6P1  MATRIX 

-1.2512981E+I1  +J(  1.2946895E+I1) 

-1.2512981E+I1  +J(  -1.2946895E+A1) 

-2.6646129E+M  *J(  %.  ) 

-5.8448375E+M  W(  f.  ) 

-2.56997ME+I1  +J<  f.  ) 

-1,8I736#9E+#1  +J(  6.6542I29E-I1) 

-1.8I736I9E+I1  +J(  -6.6542I29E-I1) 

ENTER  STATE  AND  IC  VALUE  (•/  TERMINATES):  5  >1/ 

2  PLOTS  OF  5  VARIABLES  NAY  BE  PRINTED  AT  THE  TERMINAL  --  SPECIFY  NUMBER 
FOR  EACH  <N1,N2)  »/ 

MORE  TIME  RESPONSE  RUNS  (Y  OR  N)  >n 

CONTROLLER  DESI6N  <Y  OR  N)  >n 


\  -r-  r? 


>iv. 

i 

m 


X- 


FILTER  OESISN  (Y  OR  N)  >n 
END  OESISN  RUNS  (Y  OR  N)  >y 

RE6/PI  SAINS  WRITTEN  TO  ’SAVE’  FILE 


PROGRAM  EXECUTION  STOP 
STOP 

ftSIM  MAXIMUM  EXECUTION  FL. 

1.791  CP  SECONDS  EXECUTION  TIME. 


iff*  PROGRAM  nAI N ( I MPUT =64 1  OUTPUT =64 , L I ST *64 , 

Ilf*  i  SAVE*64,DATA«64,PL0T=64, 

12f*  1  TAP£3*INPUT , TAPE6*0UTPUT,TAPE25*SAVE, TAPE3#*DATA, 

13#*  2  TAP£99=PLOT,  TAPE16=LIST) 

14f*C 

|if*CWWHHHHHmHWHHmHHHIHHHHHimHHHHHHHWmi 

16#*C 

17f*C  C8T/PI/KF  DESIGN  PROGRAM  IC6TPIV).  ORIGINAL  VERSION  WITTEN  BY  CAPT 
1B#*C  R.N.  FLOYD  (1901).  MAJOR  MODIFICATION  HADE  BY  LT  A.  MOSELEY  (1982). 

19f*C  PREVIOUS  VERSIONS  ARE  DOCUMENTED  IN  THE  AUTHORS’  THESES  116,341. 

2ff*C 

21f*C  DATE  LAST  REVISED:  28  OCT  83 
22#*C  LIBRARIES  USED:  0LKL1B,  !D*T82f3f3 
23f*C 

25f*C 

26#=  C0M0N/HAIN.1/NDIM,  NDIM1 ,  CONI  ( 4##) 

27#=  COMHON/NAIN2/COH2 (4ff ) 

28f=  COMMON/ IN0U/K1N, KOUT , KPUNCH 

29#*  C0MN0N/F1LES/KSAVE, WATA.KPLQT, XLIST, KTERM 

3ff*  C0HH0N/SYSHTX/NVSH,SM<2125> 

31#*  COHMON/ZNTXl/NVZNy  ZH1  ( 1225) 

32#*  COMMON/  ZNTX2/ZH2U22S) 

33#*  COMNON/OSNHTX/NVDH, NODY , NOEY , DM< 1 73#) 

34#=  CONMON/CNDMTI/NVCM,NEKH,  M0DC,CN(225) 

33#=  COMHON/TRUHTX/NVTH, TH ( 1723) 

36#=  COHHON/CIMTROL/NVCTL, CTL(9ff > 

37#*  G0NM0N/CRE6PI/NVRPI,RPI (373) 

38#*  COMMON/CCST /NVC6T,C6T (4ff ) 

J9#*_  _  COMWH/CKF/NVFLT,  IJJ  (691) _  _  _ 

♦if*  COMMON/ AMC/AH4  IN)  “  ^ 

41 #*__  _COHMOM/BD6/BO(73)_ _ _ _  J 

429*  NDIN*4ff  ~ 

43f*  NVSM*2123 

44#=  NVZN*1223 

45#=  NVDN*173f. 

461=  NVCM*223 

47f=  NVTM*1723 

48#*  NVCTL*9#f 

49#*  NVRPI*573 

3##*  NVC8T*4ff 

51#*  NVFLT*69# 

52#*  KIN-5 

53#*  KSAVE*23 

541*  KDATA*5# 

35#*  KPLQT*99 

56f*  KLIST*16 

57#=  KTERM*6 

58#*  CALL  C6TXQ 

59#*  STOP 

6##*C  END  MAIN 
61#*  END 

62#*  SUBROUTINE  DSND(ND) 

63#*  DIMENSION  NDU) 


72f«C  END  SUBROUTINE  DSNO 
73M  END 

74#*  SUBROUTINE  OSMN(A,Bf EX,S,0,C,DVtEYf HfHNtRf ANt6H,QN) 

75 •*  DIMENSION  A(8,B),B<8,2),C<2,8),6<8>,DY<2,2),H(3,B),R(3,3> 

761*  DATA  SRAVTY,DE6TRD,Pl/32. 174,. #1745329, 3. 1415927/ 

771*  CALL  ACDATA1LEVEL, VT, ALT, ALPHA, ZA, ZAD, ZB, ZU, ZDE, ZDF, 

78#*  1  PHA, PNAD, PMO, PNU, PMDE, PMDF, I A, IAD, ID, IU, IDE, IDF, 

79#*  2  TE, DLX, BSPAN) 

8##*  1#  ALPHAR*DE6TRD«ALPHA 
81#*  U#*VT«COS4ALPHAR) 

82#*  H#*VT«SIN(ALPHAft) 

83#*  A(l,3)*l. 

84#*  A(2,l)*-G8AVTY»SIN<ALPHAfi)/U# 

85#*  A(2,2)*ZA 

86#*  A(2,3)*1.+ZQ 

87#*  A(3,2)*PNA 

AI3,3)*PMQ 
A42,7)*ZA 
A(2,8)*Zfl 
A<3,7)*PNA 
A(3,8)*PHQ 
A(2,4)*ZDE 
A(2,5)*ZDF 
A13,4)*PMDE 
A(3,5)*PNDF 
A(4,4)*-TE 
A15,5)*-TE 
D(4,1)*TE 
B(5,2)*TE 

CALL  GUSTS (LEVEL, ALT, SLU, SLH, SI6U, SISK) 

A(6,6)*-VT/9LN 

A (7, 6)* ( 1 . -SORT (3. )) «SI6N«S8RT <-A (6, 6) ) /SLN 
A(7,7)*A(6,6I 
A(B,8)*-VT*PI/4. /BSPAN 
A(8,6)*-A(B,8)tA17,6) 

A(8,7)*-A(8,8)*A(7,7) 

6(6)*1. 

617) *SI 6N*SQRT (3. tVT/SLN) /VT 
6(8)*~A(8,8)*6(7) 


R(l,l)*4.76E-6 
R (2, 2) *1 .22E-5 
R(3,3)*3.22E-5 


123#*C  END  SUBROUTINE  DSNH 

124#* 

END 

125#* 

SUBROUTINE  TRTHD4NDI 

126#* 

DIMENSION  HD ( 1 ) 

29#- 
291* 

3##» 

311* 

132#*C  END  SUBROUTINE  TRTHD 
1331*  END 

134#*  SUBROUTINE  TRTWI ( AT, BT, 6T, BT, HT, RT , TDT, TNT ) 

133#*  DIMENSION  AT  19, 9) , BT (9, 2) , ST (9) , HT (3, 9) ,RT(3,3) , TDTI8, 9) 
136#*  DATA  6RAVTY,DE6TRD, PI/32.174, .#1745329, 3.1415927/ 

137#*  CALL  ACDATA (LEVEL, VT, ALT, ALPHA, ZA,ZAD, ZB, ZU,ZDE,ZDF, 

138#*  1  PHA,PMAD,PM,PMU,PHOE,PMDF,XA,XAD,XB,XU,XDE,XDF, 

139#*  2  TE, OLX, BSPAN) 

14##*  1#  ALPHAR*DE6TRD«ALPHA 
141#=  U#*VT*COS(ALPHAR) 

142#*  H#=VT«SIN(ALPNAR) 

143#*  R2AD*1./(1.-ZAD) 

144#*  AT(1,3)*1. 

145#*  AT (2, 1 1*-SRAV7T»S/N(ALPUAR) /U# 

1460*  AT(2,2)*ZA 

147#*  AT(2,3)*1.+Z0 

148#*  AT (2,4)*ZU 

149#*  AT(3,2)*PNA 

15##-  AT(3,3)*PM0 

131#*  AT(3,4)*PHU 

152#*  AT ( 4, 1 ) *-6RAVT Y*COS ( ALPHAR) 

153#*  AT(4,2)*XA 

154#*  AT(4,3)«XB-N# 

155#*  AT(4,4)*XU 

156#-  AT(2,5)*ZDE 

157#*  AT(2,6)*ZDf 

158#*  AT(3,3)*PMDE 

159#*  AT(3,6)*PMDF 

16##*  AT(4,S)*XDE 

161f*  AT(4,6)*XDF 

162#*  AT(5,3)*-TE 

163#*  AT (6,6) *-TE 

164#*  AT(2,8)*ZA 

165#*  AT (2,9)*ZB 

166#*  AT(3,8)*PHA 

167#*  AT(3,9)»PM8 

168#*  AT(4,8)*XA 

169#*  AT(4,9)*X8 

17##*  CALL  6USTS(LEVEL,ALT,SLU,SLN,SI6U,SI6N) 

171#*  AT(7,7)«-VT/SLN 


111 


1721*  AT (8,7)*(1.-S8RT (3. ) )*SIGU*SQRT (-AT (7,7) ) /SLR 

1731*  AT(8,8)*AT(7,7) 

174#*  AT(9,9)*-VT*PI/4./BSPAN 

1731*  AT(9,7)*-AT<9,9)*AT(8,7) 

1741*  AT (9,8)*-AT (9,9)*AT (8,8) 

1771*  8T(7)*1. 

1781*  6T (8) *SI6H*SQRT (3. *VT /SUI) / VT 

1791*  ST (9)*-AT (9,9)*6T (8) 

lBff*  BT*1. 

1811*  08  2f  1*1,9 

182#*  AT(2,I)=AT(2,I)*RZAD 

183f*  AT(3,I)*AT(3,I)*PHAD«AT(2,I) 

184#*  2#  AT14, I) *AT (4, I ) *ZAD*AT 12, I ) 

183#*  BT(5,1)*TE 

184#*  BT(4,2)*TE 

187#*  HT(1,1)*1. 

188#*  HT(2,2)*1. 

189#*  HT(3,3)*1. 

19##*  HT(2,8)*1. 

191#*  RT(l,l)*4.74E-4 

192#*  RT(2,2)*1.22E-5 

193#*  RT(3,3)*3.22E-5 

194#-  TBT(1,1)*1. 

193#*  TDT(2,2)*1. 

194#*  TDT(3,3)*1. 

197#*  TDT(4,3)*l. 

198#*  TDT(3,4)*1. 

199#-  TOT (4,71*1. 

2###*  TDT(7,8)*1. 

2#1#»  TDT(8,9)*1. 

2#2#»  RETURN 

2#3#*C  END  SUBROUTINE  TRTHH 
2#4#*  END 

2#3#*  SUBROUTINE  ACOATA (LEVEL , VT, ALT, ALPHA, ZA, ZAD, ZO, ZU, ZDE, ZDF, 
2#4#*  1  PHA, PNAD, PRO, PNU, PHDE, PHOF , XA, ZAO, XB, XU, XDE, XDF , 

2#7#*  2  TE,DLX,BSPAN) 

2#8«*  COMHON/FILES/KSAVE, KDATA, KPLOT , KLIST, KTERM 

2#9#»  DATA  NENTRY/1/ 

'  21##*  3  WRITE  1(1 
211#*  READ*, LEVEL 

212#*  IF((LEVEL.GT.3).OR. (LEVEL.LT.il)  60  TO  5 

213#*  WRITE  1(2 

214#*  READ*, VT, ALT, ALPHA 

213#*  WRITE  1#3 

214#*  READ*, ZA, ZAD, Z8,ZU, ZDE, ZDF 

217#*  WRITE  l»4 

218#*  READ*, PHA, PNAD, PNQ, PNU, PHDE, PHDF 

219#*  WRITE  1#3 

22##*  READ*, XA, XAD, IQ, XU, XDE, IDF 

221#*  WRITE (KLIST, l#l) 

222f*  WRITE (KLIST, 1#9)  LEVEL 

223#*  WRITE (KLIST, 1#2) 

224#*  WRITE 4KLIST, 11#)  VT, ALT, ALPHA 

225#*  UNITE (KLIST, 1#3) 


226 0*  MftITE (KLISTf  1 1 0)  ZA,ZAD,ZQ,ZU,ZDE,ZDF 

2271*  MITE  (KLIST,  104) 

2280*  WRITEfKLIST,  110)  PHA,PNAD,PHQ,PNU,PNDE,PNDF 

2291*  WRITE (KLIST, IfS) 

23M*  MITE  (KLIST,  Ilf)  XA.XAD,  IQ,  IU,  IDE,  XDF 
2311*  IF(NENTRY.£8.0)  80  TO  If 
2321*  BSPAN*3f. 

2331*  011*13.798 

2341*  TE*2f. 

2331*  RETURN 

236#*  If  MITE  lf6 
237f*  READ*,TE 

238#*  MITE  lf7 

239#*  READ*,  DU 

24##*  MITE  lf8 

2410-  READ*, BSP AN 

242f*  lfl  FORNATC  ENTER  TURBULENCE  LEVEL  (1,2,3)  >') 

243#*  112  FORMAT C  ENTER  TRIM  VELOCITY,  ALTITUDE,  AND  ALPHA  >') 

244#-  lf3  FORMAT ('  ENTER  ZA,  ZAD,  ZB,  ZU,  ZDE,  ZDF  >') 

2430*  104  FORMATS  ENTER  HA,  NAD,  HO,  MU,  NOE,  NDF  >’> 

2460*  105  FORMAT (*  ENTER  XA,  I AD,  IS,  IU,  IDE,  IDF  >a> 

2470*  106  FORMAT!"  ENTER  TINE  CONSTANT  FOR  ELEVATOR  >') 

2480*  107  FORNATC  ENTER  DISTANCE  FROM  C6  TO  ACCELEROMETER  >") 

2490*  108  FORNATC  ENTER  WINS  SPAN  >*) 

2500*  109  F0RMAT(6I,I1) 

2510*  110  F0RIMT(6(6UPE13.7)) 

2520*  RETURN 

233#«C  END  SUBROUTINE  ACDA7A 
2540*  END 

2350*  SUBROUTINE  8USTS (LEVEL , ALT, SLU , SLW, SI6U, SIGN > 

2560*  DIMENSION  ATRB1(4),ATRI2(4),ATR83(4),SI6T1(4),SI8T2(4),SI6T3(4) 

2370*  DATA  ATRB1/2000., 2730.,  10000.,  30000./ 

2580*  DATA  ATRB2/2000., 2750., 100M., 45000./ 

2590*  DATA  ATRB3/2000. ,5M0. .20000. ,70000. / 

2600*  DATA  SI6T1/4.S, 5. ,5. ,#. / 

2610*  DATA  SI6T2/8.3, If. , 10. ,0./ 

2620*  DATA  SI6T3/12. ,21. f 21.,0./ 

2630*  DATA  IT1,IT2,IT3/1,1,1/ 

2640*  IF (ALT-1750.)  3,15,15 

2650*  5  IF (ALT-1000.)  8,10,10 

2660*  8  ALTT-ALT 

2670*  SO  TO  12 

2680*  10  ALTT-1000. 

2690*  12  SI6N*2.S*FL0AT (LEVEL) 

2700*  SI6U*l./(. 177*8. 23E-4*ALTT) **. 4 

2710*  SLN*ALTT 

2720*  SLU»ALTT»SI8U*#3 

2730*  SI8U*SI6U*SI6N 

2740*  GO  TO  100 

2750*  15  SLU*175f. 

2760*  SLN*1750. 

2770*  IF (LEVEL-2)  17,18,16 

2780*  16  CALL  TBLUPt ( ATRB3, SI8T3, 4, IT3, ALT, SI6U) 

2790*  60  TO  19 


2888*  17  CALL  TBLlff>l  ( ATRB1  f SI6T1 , 4,111, ALT, SI6U) 

2818s  SO  TO  19 

2821s  18  CALL  TBLUP1 (ATRB2, SI6T2,4t IT2,ALTf SI6U) 

2838s  19  SI6N*SIGU 

2848s  188  RETURN 

2858*0  END  SUBROUTINE  BUSTS 

2848s  END 

2878s  SUBROUTINE  TBLUP1  (X, Y,ll9 IXP,XP,YP> 

2888s  DIHENSION  X(1),Y(1) 

2898s  IF (IIP)  15,15,1 

2988*  1  IF(IXP-N)  18,18,5 

2918s  5  IIP«N 

2928s  60  TO  18 

2938s  18  IF(IP-HIIP))  12,18,28 

2948s  12  IXP«IIP-1 

2958s  IF(IXP)  15,15,18 

2968s  15  IIP»1 

2978*  18  YPSY(IXP) 

2988s  RETURM 

2998*  28  lF(lXP-N)  21,16,5 

3888s  21  1XPP1*IXP+1 

3818*  22  IFIXP-X(IXPPin  25,38,38 

3828s  25  YP*Y(IXP)*(XP-X(IXP))/(X(IXPP1)-X(IXP))»(Y(IXPP1)-Y(IXP)) 

3838*  RETURN 

3848*  38  IXP*IXPP1 

3858*  SO  TO  21 

3N60*C  END  SUBROUTINE  TBLUP1 

3878s  END 

3888*  SUBROUTINE  C6TX8 

3898*  CQWNM/NAIN1/NDIN,  NDIN1 ,  CONI  ( 1 ) 

3188*  C0m0N/HAlN2/C0H2(l> 

3118s  CON10N/INOU/K1N,KOUT,KPUNCH 

3128*  C0M0N/DESI6N/NVC0H,  TSANP,  LFLRPI ,  LFLCGT,  LFLKF,  LTEVAL,  LABORT 

3138s  COHHQN/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERN 

3148*  C0NINM/SYSNTX/NVSH,SN(1) 

3158*  COMMON/ ZHTX1 /NVZN, ZH1  ( 1 ) 

3168*  C0NMN/ZHTX2/ZH2(i) 

3178*  CONHON/NDIHD/NND, NRD,NPD, NMD, NDD, NMD, NNDD, NPLD, NNPNHD, NNPR 

3188*  COHMON/LOCD/LAP, L6P, LPHI , LBD, LEXy  LPHO, LB, LBN, LQD, LC, LBY , LEY, LHP , LR 

3198s  COHMON/DSNNTX/NVDH, NODY, NOEY, DH ( 1 ) 

3288*  COMHON/NDIHC/NNC,NRC,NPC 

3218*  COHNON/LOCC/LPHC,LBDC,LCC,LK 

3228*  COMHON/CNDMTX/NVCN,NENCH,NODC,CN(1) 

3238*  COHHON/NDINT/NNT,NRT,NNT,NNT 

3248s  COMMON/LOCT/LPHT ,  LBDT,  LOOT,  LHT,  LRT,  LTDT,  LTNT 

3258*  C0HH0N/TRUNTX/NVTH,TN<1) 

3268*  C0RN0N/LCNTRL/LPIll,LPU2,LPI2i,LPI22,LPHDL,LBDL 

3278s  COMHON/CONTROL/NVCTL , CTL ( 1 ) 

3288*  COMNON/LREBPI /LXDN, LUDN, LPHCL, LKX, LKZ 

3298s  C0NM0N/CRE6PI /NVRPI , RP! ( 1 ) 

3388*  C0HH0N/LC6T/LAU,LA!3,LA21,LA23,LA12,LA22,LKIA1!,LKXA12,LKXA13 

3318*  CON«ON/CC8T/NVC6T,C8T<1) 

3328*  COIM)N/LKF/LEADSN,LFLTRK,LFCQV 

3338*  COHHON/CKF/NVFLT, FLT  < 1 ) 


M2 


COHHON/AMC/AHU) 

COHHQN/BDG/BDU) 

OIHENSION  L0(15),M0(1S)  _ 


DATA  NPLTZH/696/ 

DATA  1E0I,N0/-1,1HN/ 

REBIND  KLIST 

BRITE (KLIST, 115)  DATE (OUH), TINE (DUN) 

WtlTE (KTERM, 1 IS)  DATE (DUN), TINE (DUN) 

115  F0RHATCl“,27Xf  •*  *  ♦  C6TPIF  *  *  *'/14X, 

1  'PROGRAM  TO  DESI6N  A  COMMAND  GENERATOR  TRACKER'/SX, 

2  'USING  A  REGULATOR  BITH  PROPORTIONAL  PLUS  INTEGRAL  CQNTROL'/lAX 

3  'AND  A  KALHAN  FILTER  FOR  STATE  ESTIHATI0N.‘/28X, 

4  '*  *  *  CBTPIF  »  *  *'//UX, 'DATE  :  \A1B//,11X, 

5  'TINE  :  ',A1 I////) 

REBIND  KSAVE 
REBIND  KDATA 

_  BRireiNSAVEjmJJEq^NPLTZJJ. _ 

ID  1=1.15  ~  “ 


ID  ND(I)=D 
DO  12  1=1,15 
12  LD(1)=1 

LFLRPI*# 
LFLC6T=f 


LTEVAL=f 

LABORT=f 


LFAVAL-9 


NVCON=NIND(NDIH,NVZN) 
KOUT=KLIST 
KPUNCH=KPLOT 
IF(NVSN.SE.NPLTZN)  SC 
BRITE  lfl,NPLTZH 


3739=  59 

KITE  192 

3749= 

READ*,TSAMP 

3759= 

IF(TSAHP.LE.9.)  GO  TO  59 

3769= 

BRITE (KLIST, 193)  TSAHP 

3779=  193 

F0RHATC9SAHPLE  PERIOD  IS  ',F5.3,'  SECONDS') 

3789= 

CALL  SETUP(ND, LD, ICGT, ITRU, 1 ) 

37?9» 

IF(LABORT)  1999,199,1999 

3899=  199 

LAB0RT*9 

3819= 

INPLIC*9 

3829=  BRITE  194 

3839=  194  F0RNATC9C0NTR0LLER  DESIGN  (Y  OR  N)  >') 

3849*  READ  111, IANS 

3859=  IF (IANS. EO. NO)  60  TO  599 


CALL  PIHTKIPI) 


3881-  IF(LABORT)  10ff ,  125, 

3898*  125  MITE  115 

3900*  105  FORMAT (‘iDESIGN  RE6/PI  (Y  OR  N)  >‘> 


3910*  READ  111, IANS 

3920*  IF(IANS.EQ.NO)  60  TO  150 

1  3930*  WRITE  400  1 

3941*  410  FORMAT  (^INCORPORATE  IMPLICIT  MODEL  (Y  OR  N)  >') 

3950*  READ  111, IANS 

3960*  IF ( I AMS. EB. NO)  80  TO  491 

3970*  INPLIC*! 

3980*  CALL  SETUPIND,LD,IC6T,ITRU,4) 

3990*  IF(IC8T.NE.0)  80  TO  460 

4000*  INPLIC*0 

4010*  80  TO  480 

4020*  460  IF(NPD.EB.NNC)  60  TO  480 

4030*  WRITE  470 

4040*  470  FORMAT (  '0COMHAND  MODEL  STATE  DIMENSION  MUST  EQUAL  SYSTEM 
4050*  10UTPUT  DIMENSION') 

4060*  LAB0RT*-1 

4070*  480  IF (LABORT)  100,490,1000 

4080=  490  CALL  SREGPI (INPLIC) _ 


IF(LABORT)  1000,200,1000 
4100*  150  WRITE  106 

4110*  106  FORMAT ( "0OE5I6N  C6T  (Y  OR  N)  >') 

4120*  READ  111, IANS 

4130*  IF(IANS.EQ.NO)  60  TO  100 

4140*  CALL  SETUP(N0,LD,1C6T,ITRU,2) 

4150*  IF(ICGT)  155,100,155 
4160-  155  IF (LABORT)  100,160,1000 
4170*  160  CALL  SCOT 
4180*  IF (LABORT)  100,170,1000 
4190*  170  IF (LFLC6T.LE.0)  60  TO  125 
4200*  200  LABORT-0 
4210*  WRITE  107 

4220*  107  FORMAT  (CONTROLLER  EVALUATION  WRT  TRUTH  MODEL  (Y  OR  N)  >') 

4230*  READ  111, IANS 

4240*  IF (IANS.EB. NO)  60  TO  250 

4250*  CALL  SETUP (ND, LD, IC6T , ITRU, 3) 

4260*  IF (LABORT)  200,260,1000 
4270*  250  LTEVAL*0 
4280*  260  CALL  CEVAL 


IF (LFLC6T. EB. 1 )  L6C6T-1 
4300*  IF (LFAVAL. Efi. 0. 0R.L6C6T. EB. 0)  60  TO  100 

4310*  270  WRITE  600 

4320*  600  FORMAT  COWRITE  PERFORMANCE  EVALUATION  DATA  TO  ’SAVE’  FILE  (Y  CR  N) 
4330*  ♦>') 

4340*  READ  111, IANS 

4350*  IF(IANS.EQ.NO)  60  TO  100 

4360*  1C0DE-IC0DE+1 

4370*  CALL  PFDATAUCODE.NO) 

4380*  INUH*IC0DE-4 

4390*  WRITE  605, INUM 

4400*  605  FORMAT! '(PERFORMANCE  EVALUATION  DATA,  NO.  M2,1, WRITTEN  TO  ’SAVE 
4410*  ♦’  FILE') 


tfiBfi 


4430=  500  LABORT=0 
4440=  MITE  108 

4450=  108  FORMAT C "0FILTER  DESIGN  (Y  OR  N)  >') 
4460=  READ  111, IANS 

4470=  IF(IANS.ES.NO)  GO  TO  900 

4480=  CALL  FLTRK(IFLTR) 

4490=  IF(IFLTR.E8.0)  80  TO  900 

4500=  IFILA80RT)  1000, 510, 100# 

4510=  510  CALL  SETUP(ND,LD, IC6T, ITRU, 3) 

4520=  1F1LAB0RT)  500,525,1000 

4530=  525  CALL  FEVAL  _ 

r~  4540=  530  IF(LABORT)  1000, 540, 1000 

1  4550=  540  LFAVAL*1 

*  IF (L6C8T.ES. 1)  GO  TO  270 


[IJ 


4960*  C0HNQN/DESI6N/NVCQH,  TSAKP ,  LFLRPI ,  LFLCST ,  LFLKF ,  LTEVAl,  L  ABORT 

4970*  COMHON/SYSHTX/NVSH,  SHU) 

4980*  GOHItQN/  ZHTX 1  /NVZH,  ZH1 U » 

4990*  COMMON/ ZHTX2/ZN2 ( 1 ) 

5000*  COMMON/NDIND/NND, NRD,  NPD,NND,  NOD,  MID,  MOD,  NPLD,  NWPNHD,  NNPR 

5010*  OIHENSION  ND ( 1 ) , LD (1 ) 

5020*  NSI2E*0 

5130*  CALL  RSYS (SH,LD, ND, 1,NSIZE> 

5040*  IF (LABORT. ST. 0)  RETURN 

5050*  NSIZE*NNPR 

5060*  IF (NPLD.ST.NSIZE)  NSIZE*NPLD 

5070*  NSIZE*NSIZE*NSIZE 

5080*  IF(NSIZE.LE.NVCON)  SO  TO  5 

5090*  MITE  101 ,  NSIZE 

5100*  101  FORMAT ( a0INSUFFICZENT  NENORY  /MINI/ , /HAIN2/, /ZNTX1  / , /ZNTX2/ ,  MED 
5110*  l:  *,I4) 

5120*  LABORT*NSIZE 

5130*  RETIffiN 

5140*  5  IF(NRD.EQ.NPD)  80  TO  10 
5150*  MITE  102 

5160*  102  FORMAT  C0NUHBER  OF  INPUTS  AND  OUTPUTS  NUST  BE  EQUAL  FOR  DESIGN') 
5170*  LABORT*-! 

5180*  RETURN 

5190*  10  CALL  DSCRTD(L0,ZH1,ZH2) 

5200*  RETURN 

5210*C  END  SUBROUTINE  SDSN 
5220*  END 

5230*  SUBROUTINE  DSCRTD(LD,ZN1,ZN2) 

5240*  C0MH0N/HA1N1 /NOIH,  NDIN1 ,  CONI  ( 1 ) 

5250*  CONHON/DESI GN/NVCOH, TSAKP, LFLRP I , LFLCST, LFLKF , LTEVAL, LABORT 

5260*  CONNON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERN 

5270*  COHHON/SYSHTX/ NVSM, SN ( 1 ) 

5280*  COHHON/NDIHD/NND,NRD,NPD,NHD,NDD,NND,NNDD, NPLD, NHPNND, NNPR 

5290*  C0HN0N/L0CD/LAP,L6P,LPHI,LBD,LEX,LPHD,LQ,LBN,LQD,LC,LDY,LEY,LHP,LR 

5300*  C0HN0N/D5NHTX/NVDM, N0DY,N0EY, DN(1> 

5310*  COHHON/LKF/LEADSN, LFLTRK, LFCOV 

5320*  COHKON/CXF/NVFLT , FLT ( 1 ) 

5330*  DIMENSION  LD(l),ZNl(l),ZH2tl) 

5340*  NDIH*NPLD 

5350*  NDIH1*NDIH+1 

5360*  CALL  POLES(SK,NNO,1,ZH1,ZH2) 

5370*  DO  1  1*1, NND 

5380*  1  IF (ZN1  (I > . ST. 0. )  LFLCBT-1 

5390*  CALL  TFRNTX(SM,Dft,NND,NND,2> 

5400*  LAP*1 

5410*  L6P«LAP*NPLD*NPLD 

5420*  IFfNND.EQ.0)  GO  TO  5 

5430*  CALL  TFRMTI(SN(LD(4)),DK(L6P),NND,NHD,2) 

5440*  5  IF4NDD.EQ.0)  60  TO  10 
5450*  L1*LADDR(NPLD,NND+1,1) 

5460*  L2*LADDR (NPLD, 1 , NND+ 1 ) 

5470*  L3*LADDR(NPLD,NND+1,NND+1) 

5480*  CALL  ZPART(DM(L1),NDD, NND, NPLD) 

5490*  CALL  TFRMTX(SM(LD(3)),DH(L2),NND,NDD,2) 


55ff> 
5511= 
5529= 
5531= 
5549=  8 
5559= 
5500* 
5579= 
5589=  19 
5599= 
5699= 
5619= 
5929= 
5930= 
5949= 
5959= 
5990= 
5979= 
5989= 
5990= 
5700* 
5710= 
5729= 
5739= 
5749= 
5750= 
5790=  15 
5779=  20 
5780= 
5799= 
5800= 
5810=  25 
5820=  28 
5839= 
5849= 
5859= 
5899=  33 
5879= 
5889= 
5899= 
5999=  35 
5910= 
5929=  30 
5930= 
5940* 
5950= 
5900= 
5970= 
5989* 
5990* 
0999* 
9019* 
0020* 
9039* 


CALL  TFRHTX(SH(LD(12>)'DR(L3),NDDtNDD,2) 

IFINM.EQ.0)  60  TO  8 

L1=L1+L6P-1 

CALL  ZPART(Dn<Li),NDDfMffl,NPU» 

L2=L ADDR ( NPLD , 1 , NRD* 1 ) ♦LBP-l 
L3=LADDR(HPLD,  NHD+1  ,HHD+1  >+LW»-l 
CALL  ZPAAT (M4L2)  t NNO. NHOD, NPU» 

CALL  TFRHTX<SHILD<13H,DH<L3>,NDD,KHDD,2) 

LPHI  *L6P+RPLD«4WPR8D 

LEA0SN*1 

CALL  NDSCRT (ONyNOIItf NT) 

CALL  OSCRT ( NPLD , DR, TSAHP , FLT , ZR1 , NT) 

LFLTRK=LEADSN+HPLD*NPLD 

CALL  TFRHTX 4M14LPHI) f FLT,NNDf NNO, 1) 

LBD=LPHI+RHD*NHD 

CALL  TFRHTX (SR, ZH1, NND, HHD,1) 

CALL  FHnUL(SHfSH4U)(2) )  yNNDf  NNO,  NR0,1XH(LBD> ) 
LEX=L8D+NRD*NRD 
IF (NOD. EQ. 0)  60  TO  15 
L1*LADDR(NPLD,1,NND*1) 

CALL  TFRRTX  f OH (LEX ) , FLT (LI ) , NND, NDDf 1 > 

LPHD=LEX+NHD*NDD 

L1*LADDR(RPLD,MRD+1,RRD*1) 

CALL  TFRHTX (OR ILPHD1 ,FLT ILi>, ROD, HDD, 1 > 

LB=LPHD+HDD*NDD 

60  TO  20 

L8=LEX 

IF (KHD. EQ. 0)  60  TO  25 

CALL  FTHTX (SH(LD(5) 1 , DR (L8) , NWD, NND) 

L8N=L8*NND*NND 

60  TO  28 

L8N*LB 

IF (NMDO.E8.0)  60  TO  33 

CALL  FTHTX(SR(LD(14))IDH(L8R),NWD,NHDD) 

L8D=L0N+NNDD*NNDD 

60  TO  35 

L8D*L8N 

IF4NHPNMD.6T.0)  60  TO  35 

LC*L8D 

60  TO  39 

CALL  8DSCRT (DRILB)  f DH4L8N) , ZH1, ZH2> 

LC=LBD*NPLD*NPLD 

LDY*LC*HPD*HHD 

LEY*LDYHK>D«RRD 

LHP*LEY+NPD»NDD 

LR*LHP+NHD»HPLD 

L1*LR+NHD*NH0-LC 

CALL  FTRTX(SR(LD(0)),DR{LC)fLl,l) 

L1*LEY-1 

N0DY*1 

DO  49  1*L0Y,L1 
IF(DR(I).E8.0.)  60  TO  40 
NODY*0 
60  TO  45 


D-21 


6949*  4f  CONTINUE 

6959*  45  NOEY=l 

6»60s  IFINDO.LT. 1)  60  TO  55 

6979*  LI*LHP-1 

6180s  DO  5f  I*LEY,L1 

609f>  IF(DH(I).EB.9.)  60  TO  51 

6199*  NO£Y*f 

6111*  60  TO  55 

6121*  51  CONTINUE 

6130*  55  CALL  HATLST(DN(LPHl),NNB,NND,*PHIa,KLIST) 

6140*  CALL  HATLST (DH(LBD) ,NND,NRO, ‘BO'.KLIST) 

6151*  IFINNPNND.6T.9)  CALL  NATLST (DH(LBD) , NPLD,NPLD, aBDa,KLIST) 

6161*  IF(NHD.6T.9)  CALL  HATLST<DH(LHP),NRD,NPLD,aHAa,KLIST) 

6171*  IF(NDO.ES.f)  RETURN 

6180s  CALL  HATLST (0H4LEX) fNNO, MDD, aEXDa,KLIST) 

6199*  CALL  NATLST(DH<LPHD)lNDD,NOO,*PHNa,KLIST) 

6299*  RETURN 

6210*C  END  COROUTINE  DSCRTD 

6229*  END 

6239*  SUBROUTINE  0DSCRT(fl,BN,ZRl,ZH2) 

6249*  C0HH0N/HAIN1/NDIH,N0IH1,C0H1 (1) 

6259*  COHHON/DESIGN/NVCOH, TSAHP, LFLRPI, LFLC6T, LFLKF.LTEVAL, LABORT 

6269*  COHHON/NOIHD/NND,NRD,HPO,  NND,  NDO,  NNB,  NNDD.NPLD,  NNPNND,  NNPR 

6279*  COHHON/LOCD/LAPlLGP,LPHt,LBD,LEX,LPHD,LO,LBNlLBD,LC,LDY,LEY,LHP,LR 

6289*  C0HH0N/DSNHTX/NVDR,N0DY,N0EY,DH(1) 

6299*  DINENSION  0<1),0N(1),ZH1(1),ZH2(1) 

6399*  IF (NND. EB. 9)  60  TO  5 

6319*  CALL  TFRHTX (B, 2H1 , NND, NND, 2) 

6329*  3  IF  (N44DD.EB.  9)  60  TO  19 

6339-  L1*LADDR(NPLD,NND*1,NND*1) 

6349*  CALL  TFRHTX(flN,ZHl(Li>,NNDD,NNDD,2) 

6339*  IF (NNB. EB. 9)  GO  TO  19 

6369*  L1*LADDR(NPLD,  1,NNDM) 

6379*  CAU  ZPART(ZN1(L1),NND,NNDD,NPLD) 

6389*  Ll*LADDR(NPLD,NND+l,l) 

6399*  CAU  ZPART (ZH1  (LI)  ,NWD,NND,NPLD) 

6499*  19  CALL  HAT3(NPLDf NNPNI(0yM(L6P> f Zlfly ZK2) 

6419*  CALL  INTE6(NPLD,DH (LAP), ZH2,DH(LBD), TSAHP) 


6429*  RETURN 

6439*C  END  SUBROUTINE  BDSCRT 

6449*  END _ 

6459*  SUBROUTINE  SCHDtNP.LD.ICBT.ITYPE) _ 

6469*  C0HH0N/DESI6N/NVC0H, TSAHP, LFLRPI, LFLCBT  y  LFLKF  y  LTE VAL  y LABORT 

6479*  COMON/FILES/KSAVE,  KDATA,  KPLOT,  KLIST,  KTERH 

6489*  COHHON/SYSNTX/NVSN, SN (U 

6499*  COHHOM/ZHTX 1  /NVZH,  ZN1  ( 1 ) 

6599*  C0HH0N/ZHTX2/ZH2(1) 

6519*  COHHON/NDIND/NND, NRD,NPD, NHD, NDD, NND, NHDD, NPLD, NNPNND, NNPR 

6529*  COHHON/NDIK/NNC,NRC,NPC 

6539*  COHHON/CHDHTX/NVCH, NENCN, NODC, CN ( 1 ) 

6549*  C0NH0N/LRE6PI/LXDN, LUDN, LPHCL, LKX , LKZ 

6559*  C0NH0N/CRE6PI /NVRPI , RPI ( 1 ) 

6569*  DIMENSION  ND(1),LI)(1) 

6579*  DATA  N0/1HN/ 


658#= 

639#= 

66##«  11# 

/ - 

6611* 

662#*  3 
663#* 

664#* 

665#* 

666#* 

6671* 

668f* 

6691* 

67##* 

671#* 

672#* 

673#* 

674#* 

673#*  8 
676#* 

677#*  1#3 
678#* 

679#=  9 
68##* 

681#- 

682#* 

683#*  1# 
684#* 

6B3#*  1#8 
686#* 

687#* 

688#*  12 
689#* 

69##* 

691#* 

692#* 

693#* 

694#* 

6958* 

696#*  15 
6978*  1#2 
698<*  1#4 
6998*  111 
7###* 
7#1#*C  END 
7#2t* 

7(38* 

7#4#* 

715#* 

786#* 

7#7#= 

7#8f« 

7#98* 

71##- 


IF  < ITYPE. Efi. 4)  80  TO  1# 

UNITE (KLIST, 11#) 

F0RHAT(////11X.5(**  *).*C6T  DESI6N*.5(*  «■)////) _ 

- deletion - / _ 

IFOFLRPI)  11,3,11 
MITE  1#2 
READ  111, IANS 
IF(IANS.£8.N0)  60  TO  8 
CALI  REA0FS(SH,NDf4t IERR) 

NSIZE-mU) 

LKX*ND(2) 

LKZ*ND(3) 

CALL  FTNTX (SH,RPI (LKX) , NSIZE, 1) 

IFUERR.NE.#)  RETURN 

CALL  NATLST(RPI(LKX),NRD,NND,*KX*,KLIST) 

CALL  HATLST (RPI (LKZ),NRD,NRD, aKZ',KLIST) 

LFLRP1— 1 
SO  TO  1# 

IF (LFLC6T.8E. 0)  60  TO  9 
MITE  1#3 

FORNATI *#SYSTEN  UNSTABLE  -  -  OPEN-LOOP  C6T  NOT  FEASIBLE*) 

RETURN 

LKX-l 

LKZ*1 

NSIZE*NRD*NHD 

CALL  ZPART(RPI(LKX),1,NSIZE,1) 

IF (IC8T.EQ.#)  60  TO  12 
MITE  1#8 

FORNATI*  MODIFY  CONNAND  MODEL  (Y  OR  N)  >*) 

READ  111, IANS 
IFdANS.E8.N0)  RETURN 
CALL  RSYSISH, LDyND(2f IC6T) 

IF (LABORT. NE. f )  RETURN 
MEHCtf-1 

CALL  POLES (SN, NNC, 2, ZN1 , ZH2) 

IF <NPC.EQ.NPD)  60  TO  15 
MITE  1#4 
LABORT*-! 

RETURN 

CALL  DSCRTC(LD,ZH1I 

FORNATI*  READ  REG/PI  GAINS  FROM  'DATA'  FILE  (Y  OR  N)  >*) 

FORNATI '(CONRANS  AND  DESIGN  MODEL  OUTPUTS  NOT  EQUAL  IN  NUHBER*) 
FORMAT (A3) 

RETURN 

SUBROUTINE  SCND 
END 

SUBROUTINE  DSCRTC(LD,ZH1) 

C0NN0N/HAIN1/N0IN, NDIN1 , CONI ( 1 ) 

C0HN0N/DESI6N/NVC0N, TSANP, LFLRPI .LFLC6T, LFLKF, LTEVAL, LABORT 
COHHON/F ILES/KSAVE, KDATA, KPLOT, KLIST, KTERN 
COHNON/SYSHTX / NVSM , SN  < 1 ) 

C0NN0N/ND1HC/NNC,NRC,NPC 
CONNON/LOCC/LPHC, LBDC, LCC , LDC 
COHHON/CNDNT I / NVCN , NEUCN , NODC,CH ( 1 ) 


711f»  DIMENSION  LD(1),ZH1(1) 

7121*  NOIM*NNC 

7131*  NDIN1*NDIH+1 

714#*  CALL  NDSCRT(SN,NOIH,NT) 

7151*  CALL  OSCRT (NOIR, SM , TSAMP, CHt  ZH1 1  NT) 

716#*  LPHC*1 

7171*  LBDC*LPHC+NNC»NNC 

718#*  CALL  NHUL(ZH1,SH{L0(2>) f NOIH.HDIR, NRCf CH(LBOC) ) 

719#*  LCC*LBDC+NNC*NRC 

72##*  LDC*LCC+NPCHMC 

721#*  L1«LDC+NPC*NRC-LCC 

722#*  CALL  FTRTX(SfMU>(3))fCI((LCC>tLl,l> 

723#*  NODC*l 

724#*  L1*L1+LCC-1 

725#*  DO  1#  I*LDC,L1 

726#*  IF(CH<I).ED.#.)  GO  TO  1# 

727#*  now:*# 

728#*  80  TO  IS 

729#*  1#  CONTINUE 

73##*  15  CALL  HATLST (CM,NNC,N)tt, *PHH*,KLIST) 

731#*  CALL  NATLST(CH<LBDC),NNC,NRC,*BDH,,ia.IST) 

732#*  CALL  HATLST<CN4LCC),NPC,NNC,aCH',KLIST> 

733#*  CALL  HATLST (CM(LDC) , NPC, NRC, *DH* , KLIST) 

734#*  RETURN 

735#*C  END  SUBROUT IIC  DSCRTC 
736#*  END 

737#*  SUBROUTINE  STRTH<ND,LD,ITRU) 

738#*  CONMN/DESISN/NVCffll,  TSAMP,  LFLRPI , LFLC6T,  LFLKF,  LTEVAL,  LABORT 

739#*  C0MWN7SYSMTX/NVSM,Slim 

74##=  C0HM0N/ZHTX1 /NVZH,  ZH1  ( 1) 

741#*  C0M90M/ZNTX2/ZN2 ( 1 ) 

742#*  COHMON/NDIHD/NND,  NRD,  NPD,  NMD,  NDD,  NND,  NNDD ,  NPLD.  NNPNND,  NNPR 

743#*  COIWON/NO IHT/NNT, NRT , NMT, NNT 

744#*  DIMENSION  ND(1),LD(1) 

745#*  DATA  N0/1HN/ 

7468*  IFdTRU.EB.#)  60  TO  5 

747#*  WRITE  1#3 

7480*  103  FORMAT C  MODIFY  TRUTH  MODEL  (Y  OR  N)  >') 

749#*  READ  111, IANS 

75##*  111  FORMAT (A3) 

751#*  IF(IANS.EB.NO)  SO  TO  2# 

752#*  5  CALL  RSYS(SM,LD,ND,3,ITRU) 

753#*  IF(LAB0RT.6T.#)  RETURN 

754#*  NSIZE*NNT«NNT 

755#*  IF(NSIZE.LE.NVCON)  SO  TO  8 

756#*  WRITE  1#1 , NSIZE 

757#*  1#1  FORHATC#INSUFFICIENT  MEMORY  /HAINl/,/HAIN2/,/ZHTJtl/,/ZHTX2/,  NEED 
758#*  l:  M2) 

759#*  LA80RT*NSIZE 

76##*  RETURN 

761#*  8  IF ((NRT. ED. NRD). AND. (NMT. ED. NMD))  60  TO  1# 

762#*  WRITE  1#2 

763#*  1#2  FORMAT <*#INPUTS  AND  MEASUREMENTS  MUST  BE  EBUAL  IN  NUMBER  FOR  DESI6 
764#*  IN  AND  TRUTH  MODELS*) 


7650*  LABORT*- 1 

7660=  RETURN 

7670=  10  CALL  POLES (SH, NNT, 3, ZH1 , ZN2) 

7680=  CALL  OSCRTT(LD,ZHl) 

7690=  20  LTEVAL* 1 

7700»  RETURN 

7710*C  END  SUBROUTINE  STRTH 
7720*  END 

7730*  SUBROUTINE  DSCRTT(LD,ZHi> 

7740*  COHMM/HAIN1/NDIN,  NDINl ,  CONI  ( 1 ) 

7750*  C0HN0N/DESI6N/NVC0H,  TSANP,  LFLRPI ,  LFLC6T,  LFLKF,  LTEVAL,  LABORT 

7760*  CONNM/SYSNTX /NVSH,  SH  ( 1 ) 

7770*  CONNON/FlLES/KSAVE,KDATA,KPLQT,KLIST,KTERN 

7780*  COHHON/NOIHD/NND,NRD,  NPD,  NND,  NDD,  NHD,  NNDD, NPLO, NNPNND, NNPR 

7790*  COIWM/NOINT /NNT,  NRT ,  NNT ,  NNT 

7800*  CONNON/LOCT/LPHT.LBDT,  LOOT,  LHT,  LRT,  LTDT,  LTNT 

7810*  CONHON/TRUNTX/NVTN,TN(l) 

7820*  DIHENSION  LD(1),ZN1U) 

7B30*  NDIH*NNT 

7840*  NDIN1*NDIN*1 

7850*  CALL  NDSGRT(SH,NDIH,NT) 

7860*  CALL  DSCRT(NDIN,SN, TSANP, TN,ZN1, NT) 

7870*  LPHT*1 

7880*  LBDT*LPHT+NNT»NNT 

7890*  CALL  NNUL1ZN1,SN(LD<2)),»IN,NDIN,NRT,TN(LBDT)) 

7900*  LBDT*LBDT+NNT»NRT 

7910*  IF (NHT.6T.f )  60  TO  10 

79M*  LHT*L8DT 

7930*  GO  TO  IS 

7940*  10  CALL  HAT3(NDIN,NHT,SN(LD(3) ) ,SN(U) (4) ) ,ZN1) 

7950*  CALL  INTE61NDIN,  SH, ZH1 , TN(LOOT) , TSANP) 

7960*  LHT*LQDT4lMT«NNT 

7970*  15  LRT*LHTHBIT»NNT 

7980*  LTDT»LRT+NNT*NNT 

7990*  LTNT*LTDT+NND*NNT 

8000*  L  1*LTNT >NDD*IMT  -LHT 

8010*  CALL  FTHTX  (SN(LD(5) )  f TM (LHT)  ,L1, 1) 

8020*  CALL  HATLST(TN,NNT,NNT,aPHT',KLIST) 

8030*  CALL  NATLST(TN(LBDT),NNT,NRT,,BDT,,KLIST) 

8040*  IF1NNT.6T.0)  CALL  HATLST (THtLBOT) f IWIT fNMT, sflDTBf KLIST) 

8050*  RETURN 

8060*0  END  SUBROUTINE  DSCRTT 
8070*  END 

8080*  SUBROUTINE  PINTXIIPI) 

8090*  C0NN0N/NAIN1/NDIN,NDIN1,C0N1(1) 

8100*  C0NN0N/DESI6N/NVC0N,  TSANP,  LFLRPI ,  LFLCBT,  LFLKF,  LTEVAL,  LABORT 

8110*  COHNON/F ILES/KSAVE , KDATA, KPLOT , KL I ST, KTERH 

8120*  CONHON/ZHTX 1 /NVZN, ZN1 U ) 

8130*  C0NNQN/ZNTX2/ZN2U) 

8140*  C0HMN/ND1HD/NND,NRD,  NPD,  NND,  NDD,  NND,  NNDD,  NPLO,  NNPNND,  NNPR 

8150*  CONNON/LOCD/LAP, L6P, LPNI , LBD, LEX, LPHD, LB, LBN, LSD, LC, LDY, LEY, LHP, LR 

8160*  CUHNON/DSNNTX/NVDN, NODY , NOEY , DN ( 1 ) 

8170*  C0HN0N/LCNTRL/LPI1 1 , LPI 12, LPI21 ,LP 122, LPHDL, LBDL 

8180*  CONNON/CONTROL/NVCTL, CTL  ( 1 ) 


819#*  IF(IPI.Efl.l)  RETURN 

82 ##*  WRITE (KLIST, 119) 

821#*  Ilf  FORMAT <////llX,5<"*  *), 'CONTROLLER  SET-UP', 5f  *')////) 

822#*  ND1H*NNPR 

823#*  NSIZE*NDIH*(2»NDIH+NPD) 

824#*  IF(NSIZE.LE.NVCTL)  60  TO  If 

8231*  WRITE  lfl,NSIZE 

826#*  111  FORNATCf INSUFFICIENT  MEMORY  /CONTROL/,  NEED:  *,I4) 

8271*  LABORT*MSIZE 

8281*  RETURN 

829#*  If  N0IH1-NDIH+1 

83ff*  LPI 11*1 

831f*  LP 1 1 2*LP 1 1 1 +MMD*MMD 

832f*  LPI21*LPI 12+NND*MRD 

833#*  LPI22«LPI2l*NPD*NND 

834#*  LPHDL*LPI22+NPD*NRD 

833#*  CALL  TFRHTI ( DM (LPHI ) , ZN1 , NND, NNO, 2) 

8360*  CALL  SU8KZH1, NND, NDIH) 

837#*  L2*LA00R (NDIN, 1 , NND+1 ) 

838#*  CALL  TFRHTI (OH (LBD) , ZN1 (L2) , NND, MID, 2) 

839#*  L3*LADDR(NDIH,NN0+1,1) 

84##*  CALL  TFRHTI (ON (LC),ZH1 (L3),NPD,NND,2) 

8410*  L4*LAD0R(NDIH,NND+1,NND+1) 

8420*  CALL  TFRHTI <DH (LOY) , ZH! (L4) , NPD, NRD, 2) 

8430*  CALL  6HINV(NBIH,NDIH,ZH1,ZH2,HR,1) 

8440*  IF(HR.Efl.NDIH)  60  TO  IS 

8430*  WRITE  102 

8460-  HRITE(KLIST,J02) 

8470*  102  FORHATCfPI  HATRII  IS  RANK  DEFECTIVE*) 

8480*  13  CALL  NATLST(ZH2,NNPR,NNPR,*Pr,KLIST) 

8490*  CALL  TFRHTMCTKLPHI), ZH2, NND, NND,  1) 

8300-  CALL  TFRHTI (CTL (LPI 12) , ZH2 (L2) , NND, NRD, 1 ) 

8310*  CALL  TFRHTI (CTL (LP 121 ) , ZH2 (L3) , NPD, NND, 1 ) 

8520*  CALL  TFRHTI (CTL (LPI22) , ZH2 (L4) , NPD, NRD, 1 ) 

8330*  CALL  COIF 

8540*  IPI-1 

8330*  RETURN 

&360*C  END  SUBROUTINE  PIHTI 

857#*  END 

8380*  SUBROUTINE  CDIF 

8390*  C0HH0N/HAIN1/N0IH,N0IH1,C0H1 (1) 

8600*  COHHON/NDIHD/NND, NRD, NPD, HMD, NDD, NND, NNDD, NPLD, NWPNWD, NNPR 

8610*  C0HH0N/L0CD/LAP,L8P, LPHI, LBD, LEI, LPHD,L0,LBN,L9D,LC,LDY, LEY, LHP, LR 

8620*  COHHON/DSNHTI/NVDfl,NODY,NOEY,DH(l) 

863#*  C0HH0N/LCNTRL/LPIil,LPU2,LPI21,LPI22,LPHDL,LBDL 

864#*  COHHON/CONTROL/NVCTL,CTLU) 

8630*  CALL  TFRHTI ( DH (LPHI ), CTL (LPHDL) ,NND,NND,2) 

866#*  L1»LA0DR (NDIH, 1 , NND+1 ) +LPHDL-1 

8670*  CALL  TFRHTI (DHILBD), CTL (LI), NND, NRD, 2) 

8680*  L1*LADDR  (NDIH,  NMD+1,  D+LPHDL-l 

8690*  CALL  ZPART (CTL (LI ) , NRD, NND, NDIH) 

8700*  L 1  *LADOR  (NDIH,  NND+ 1 , NND+ 1 )  +LPHDL- 1 

871#*  CALL  IDNT(NRD,CTL(L1),1.) 

8720*  LBDL*LPHDL+NDIH*ND1H 


8731*  CALL  ZPART (CTL (LBDL) , NND, NRD, NOIN) 

8748*  Ll=LAODR (HD IH. NND+1 , 1 ) +LBDL-1 

8738*  CALL  IDNT(NRD,CTL(L1),1.) 

8768*  RETURN 

8778*C  END  SUBROUTINE  COIF 

8788*  END _ 

8798*  SUBROUTINE  SRESPI(IHPLIC) _ 

8888*  COHMON/NAIN1 /NDIN,  MINI ,  COM  ( 1 ) 

8818*  COHHON/DES I6N/NVCQH , TSAHP , LFLRP I , LFLC8T , LFLKF, LTEVAL,L ABORT 

8828*  CONHON/FILES/XSAVE, KDATA, XPLOT, XLIST,  XTERN 

8838*  CQHMN/SYSHTX  /NVSH,  SH  ( 1 ) 

8848*  C0HH0N/ZHTX1/NVZH,ZN1<1) 

8838*  C0HH0N/ZHTX2/ZH2(1) 

8868*  CONNON/NDIND/NND, NRD, NPD,  MID, NDD, NND, NNDD, NPLD, NNPNND, NNPR 

8878*  C0NH0N/LCNTRL/LPIU,LPI12,LPI21,LPI22,LPHDL,LBDL 

8888*  CONNON/CONTROL/NVCTL , CTL  < 1 ) 

8898*  COHHON/LRE6P I /LXDN, LUDN, LPHCL, LKX, LKZ 

8988*  C0HHW/CRE6PI/NVRPI,RPI(1) 

891#-  IWITE  (KLIST  110) 

8928*  118  F0RHAT(////!lX,5(a*  “l,“RE6/PI  DESI6Na,5(a  •")////) 

8938*  NSIZE*NR0*(4«NRD+NND) +NNPR*NNPR 

8948*  IF(NSIZE.LE.NVRPI)  SO  TO  3 

8938*  HRITE  181  NSIZE 

8968*  181  FORHAT ( a8I NSUFF ICIENT  HENRY  /CRE6PI/,  NEED:  a,I4) 

8978*  80  TO  8 

8988*  3  NS  I  ZE*NNPR»  (3*NNPR+MD) 

8998=  IF(NSIZE.LE.NVSH)  60  TO  18 

9888*  NRITE  182, NSIZE 

9818*  182  FORHAT  <  ^INSUFFICIENT  NEHORY  /SYSHTX/,  NEED:  a,I4) 

9828*  8  LABORT*NSIZE 
9838*  RETURN 

9848*  18  LX*1 

9838*  LU*LX+NNPR«NNPR _ 

9868*  CALL  NXUS(SH(LX),SH(LU),C0H1,ZH1,ZH2.IHPUC) _ 

9878*  LUIST*LU*NNPR*NRD 

9888*  LPHP*LUIST+MPR*NNPR 

9898*  CALL  PXUP(CTL(LPHDL),CTL(LBDL),SH(LX),SH(LU),C0Hl,ZH2f 

9188*  1  SH(LUIST) , SH(LPHP) , SH(LX> , ZH1 ) 

9118*  CALL  DRIC(NDIH,SH(LPW) ,  ZH2, SH(LX) , INI , RPI  (LPHCL) ) 

9128*  CALL  6CSTAR (SH(LPHP) , CTL (LBDL) , SH (LU) , ZH1 , SH (LUI ST) , SH (LX ) , ZN2) 
9138*  CALL  TFRHTX(ZH1,SH(LX), NRD, NDIN, 1) 

9148*  CALL  FHHUL(ZH1,CTL(LPI 11) ,MRO,KND,NND,RPI (LKX) > 

9138*  L1=LADDR(NRD,1,NND+1) 

9168*  CALL  FHHUL ( ZH1 (LI ) , CTL (LPI2I ) , NRD, NRD, NND, ZH2) 

9178*  NDIH*NRD 

9188*  NDIH1*NDIN*1 

9198*  CALL  HADD1  (NO, NND, RPI  (LKX) , ZH2, RPI  (LKX) ,  1 . ) 

9288*  CALL  FHHUL(ZH1,CTL(LPI12),NRDINND,NRD,RPI(LKZ)) 

9228*  CALL  FHHUL (ZN1 IL1), CTL JLP122), NRD, NRD, NRD, ZH2) 

9228*  CALL  HADD1  (NRD,  NRD,  RPI  (LKZ) ,  Z)t2,RPI  (LKZ) ,  1 . ) 

9238*  CALL  HATLST(RPKLKX), NRD, NND, aKXa, KLIST) 

9248*  CALL  HATLSTIRPI (LKX), NRD, NND, aKXa,KTERH) 

9238*  CALL  HATLSTIRPI  (LKZ), NRD, NRD,  aKZ\KLIST) 

9268*  CALL  HATLST (RPI (LKZ ) , NRD , NRD, *KZ a , KTERH) 


927$*  LFLRPI*1 

928f<  LFLCST«0 

9290>  RETURN 

9300*C  END  SUBROUTINE  SRE6PI 


9310» 

END 

1  9320» 

SUBROUTINE  HXUS(X.U.S, ZH1 . ZH2. 1NPL1C) 

93305 

COHHON/HAINl/NDIH,NDIHl,CQHl(l) 

934#« 

C0HH0N/DESI6N/NVC0H, TSAHP.LFLRPI, LFLC6T, LFLKF , LTEV AL , L ABORT 

9330* 

CQKHON/FILES/KSAVE,  KDATAf  KPt.OTf  KLIST,  KTERN 

9340* 

COMHON/SYSMTX/NVSH,SH(l) 

9370- 

COHMON/NDIHD/NND, NRD, NPD, NMD, NDD, NND, NNDD, NPLD, NNPNND, NNPR 

9380* 

CQNHON/LOCD/LAP, LBP, LPHI , LBD, LEI, LPHD, LO,LQM, LBD,LC, LDY, LEY , LHP, LR 

9390* 

COHHON/DS1MTX /NVDN, NODY , NOE Y ,DH(1) 

9400* 

CONHON/LCNTRL/LPX 11 , LP! 12, LPI21 , LPI22, LPHDL, LBDL 

9410* 

COHHQN/CQNTRQL/NVCTL, CTL ( 1 ) 

94205 

CQMHON/LRE6PI  /LXDN,  LUDH,  LPHCL,  LKX ,  LKZ 

9430* 

COHHON/CRE6PI/NVRPI,RPI(l) 

9440* 

DIMENSION  X(1),U(1),S(1),ZH1(1),ZH2(1) 

9450* 

DATA  NO/1HN/ 

9440* 

IF(INPLIC.EO.0)  60  TO  2 

[9470= 

CALL  IHPLEXIZHI)  ~] 

94805  2 

IF(LFLRPI)  3,3,10 

9490*  s 

LXDN»1 

9500* 

LUDN*LZDN+2*NRD*NRD 

9510* 

LPHCL=LUDN*NRD«NRD 

93205 

LKX=LPHCL+NNPR*NNPR 

9330* 

LKZ*LKX*NRD*NNO 

9540= 

LMPHCL-l 

9550* 

CALL  ZPART(RPI,1,L1,1) 

9540=  10 

LUX=NRD*WD+1 

9570* 

WRITE  101, NPD 

9580*  101 

FORMAT ( "  ENTER  HEI6HTS  ON  OUTPUT  DEVIATIONS:  a,I2) 

9590* 

CALL  RflN6TS(RPI,NPD,0) 

9400* 

WRITE  102, NRD 

9410*  102 

FORMAT 1*  ENTER  NEI6HTS  ON  CONTROL  MAGNITUDES:  ’,12) 

9420* 

CALL  RUH6TS (RPI (LUX) , NRD, 1 ) 

9430* 

WRITE  103,NRD 

9440*  103 

FORMAT (*  ENTER  WEIGHTS  ON  CONTROL  RATES:  *,I2) 

9450* 

CALL  RDN8TS (RPI (LUDN) , NRD, 1 ) 

9440* 

CALL  NATLST (RPI , NPD, NPD, *Y* , KLIST) 

9470* 

CALL  OVCTOR(NPD,RPI,ZN1) 

94805 

CALL  NATLST (ZH1 ,  Itf  D, 1 , *Y* , KTERH) 

9490« 

CALL  OVCTOR(NRDvRPI (LUX) ,ZH1) 

9700* 

CALL  NATLST <ZH1  ,NRD,  1,  'UH^KTERM) 

9710* 

CALL  MATLST (RPI (LUX) , NRD, NRD, *UH* , KLIST) 

9720» 

NDIH*NNPR 

9730* 

NDIH!*MDIH+1 

9740* 

CALL  FORHX (RPI , RPI (LUX ) , DM (LC) , DM (LDY) , ZH2, ZN1 , CONI ) 

9730* 

WRITE (KTERH, 104) 

9740*  104 

FORMAT C0NODIFY  ELEMENTS  OF  ’X’  MATRIX  (Y  OR  N)  >*) 

9770* 

READ  til, IANS 

9780*  111 

FORMAT (A3) 

9790* 

IF(IANS.EO.NO)  SO  TO  20 

9800* 

WRITE (KTERH, 103) 

9811*  115  FORMAT ( *  LIST  'V  MATRIX  TO  TERMINAL  (Y  OR  N)  >') 

9828*  READ  111, IANS 

9831*  IF(IANS.Efl.NO)  80  TO  12 

9848*  CALL  NATLST <ZH2, NNPR, NNPR, ' I * , KTERM) 

9858*  12  CALL  ZHATINUH2, NNPR, NNPR, -1) 

9868*  28  CALL  NATLST(ZH2, NNPR, NNPR,  T,KLIST> 

9878*  CALL  HATLSTIRPI (LUD«) f NRO,NROf  aUR*vKLIST) 

9888*  CALL  DVCTQR<NRD,RPI(LUDN),ZH1) 

9891* _ CALL  NATLST I ZHl.NRD,lt‘UR*,KTERH) 

9988*  IF ( IMPLIC.E8.8)  60  TO  268 

9918*  CALL  H0DIFKZH2) 

9928*  268  CONTINUE 


T1*.25»TSAMP 
9948*  CALL  HSCALE(ZN1,ZN2,NDIN,NDIH,T1) 

9958*  CALL  DIA6(NDIN,C0N1,CTL(LPHDL>,1.,1.) 

9968*  _  CALL J1AT3A(NDIH,NDIN, CONI, ZHljX)__  _  _  __  _ 

1  997*=  CALL  NAT3A <MD, NDIN, CTL (LBDL) , ZH1 , U) 

I  9988*  CALL  HAT4A<C0H1,ZH1,NDIN,NDIN,NDIH,ZN2> 

|  9998*  CALL  HMUL(ZN2,CTL(LBDL),NDIR,NDIH,NRDfS) 

|  18888*  CALL  TFRNTX(RPI<LUDN),ZN1,NRD,NRD,21 

i__1881f*  _  CAL  JJADDUNRD,  NRD,  U, ZH1 , U,J[SAHP) 

18828*  RETURN  *"* 

18838*C  END  SUBROUTINE  N1US 

18848*  END 

18858*  SUBROUTINE  F0RHI(0y,RYtC,D,X,2i,Z2> 

18868*  COHHON/ND IND/NND, NRD, NPD, NND, NDD, NND, NNDD, NPLD, NHPNHD , NNPR 

18878*  DIMENSION  QY < 1 ) , RY ( 1 ) , C ( 1 ) , D ( 1 ) , I < 1 ) , 21 ( 1 ) . Z2 ( 1 ) 

18888*  CAL  FHNUL(QYfCfNPD,NPD,NND,Zl) 

18898*  CAL  FTHULtC,Zl,NP0,NND,m,Z2) 

18188*  CAL  TFRNTKZ2,I,NND,NND,2) 

18118*  L1=LADDR<NNPR,NND+1,NND*1) 

18128*  CAL  TFRHTX(RY,I(L1),NRD,NRD,2) 

18138*  L2*LADDR (NNPR, NND+1 , 1 ) 

18148*  IF(N0DY.E8.8)  60  TO  5 

18158*  CAL  ZPARTU1L2), NRD, NND, NNPR) 

18168*  60  TO  15 

18178*  5  CAL  FTHUL<D,Z1,NPD,NRD,NND,Z2) 

18188*  CAL  TFRNTX(Z2,X(L2),NRD,NND,2) 

18198*  CAL  FHHUL(0Y,D,NPD,NPD,NRD,Z1) 

18288*  CALL  FTHUL(DIZ1,NPD,NRD,(W0,Z2) 

18218*  L2*8 

18228*  DO  12  1*1,  NRD 

18238*  L1*LADDR(NNPR,NND+1,NND+I1 

18248*  DO  12  J*1,NRD 

18258*  L1*L1+1 

18268*  L2*L2+1 

18278*  X(L1)*X(L1)+Z2<L2) 

18288*  12  L1*L1«1 

18298*  15  DO  28  1*1, NND 

18388*  Ll*LADDR(NNPR,NND+i,l) 

18318*  L2*LADDR{NNPR,I,NND+1) 

18328*  DO  28  ,1*1,  NRD 

18338*  X(L2)*X(L1) 


111 


3  ■$: 

V  %  ,V 


11350s  20  L2=L2+KMPR 

10360*  RETURN 

10370*C  END  SUBROUTINE  FDRNX 
10380s  END 

10390s  SUBROUTINE  FXUPIPHIOL, BDELyX,U,SfBUIBTfUISTfPHIPf XP^Zfll) 

10400s  COHHON/HAINl/NDIN,NDINl,CONld) 

10410s  CONNON/NDIND/NND, NRD, NPD, NND, NDD, NNO, NNDD , NPLD, NNPNHO, NNPR 

10420s  SINENSION  PHIIH. ( 1 ) , BDEL ( 1 ) f X ( 1 ) , U tl > , S ( 1 ) , BUIBT ( 1  > , UIST ( 1) , 

10430=_  _1  PHIPdyPdl^ZNim _ _ 

10435s  CALL  EH)ATE(PHIP,U,NRD,NRO) 

Li 1440s _  CALL  6NlNV<MIB.NRD.PNlP.ZHliHRi  1) _ _ _ 

10450s  CALL  HAT3 (NDIN, NRD, BDEL,  ZH1 , BUIBT) 

10440s  CALL  NAT5(ZN1,S, NRD, WD, NDIN, UIST) 

10470s  CALL  NIHIL  (BDEL, UIST , NDIN, NRDf  NDIN, ZN1 ) 

10480s  CALL  HAOD1 (NDIHy NDIN, PHIOL, ZH1 ,PHIP, -1 . ) 

10490s  CALL  NHULIS, UIST, NDIN, NRD, NDIN, ZH1) 

10500=  CALL  HADD1 (NDIN, NDIN, X,ZM1,XP,-1.) 

10510=  RETURN 

10520=C  END  SUBROUTINE  PXUP 

10530=  END 

10540s  SUBROUTINE  SCSTAR(PHIP, BDEL, U,RK, UIST, SCS,ZH1) 

10550=  COHHON/HAINl/NDIH,NDIHl,CQMl(l) 

10540=  COMHON/FILES/KSAVE,  KDATA,  KPLOT ,  KLIST,  KTERN 

10570s  CONNON/NDIND/NND, NRD, NPD, NND, NDD, NND, NNDD, NPLD, NHPNHD, NNPR 

10580s  DIHENSION  PHIPd),BDELd),Ud),RKd),UISTd),GCS(l),ZMl(l) 

10590=  CALL  HAT3A  4NRO, NDIN, BDEL, RK, ZNI ) 

10400=  CALL  NADD1 (NRD,NRD, ZN1,U, ZH1, 1. ) 

10410s  CALL  6NINV(NRD,NR0,ZN1,U,NR,1) 

10420=  CALL  NAT5(U,B0a, NRD, NRD, NDIN, ZNI) 

10430=  CALL  NAT1(ZN1,RK, NRD, NDIN, NDIN, 6CS) 

10440=  CALL  NNUL(SCS,PHIP, NRD, NDIN, NDIN, ZNI) 

10450s  CALL  NADDHMO, NDIN, ZNI, UIST, 6CS,1.) 

10440=  NRITE (KLIST, 101) 

10470=  101  FORHATC0RES/PI  GAIN  NATRIX— GCS'/) 

10480=  CALL  NATI0(6CS,NRD,NDIN,3) 

10490=  RETURN 

10700=C  END  SUBROUTINE  6CSTAR 

10710=  END 

10720=  SUBROUTINE  SC6T 

10730=  COHNON/DESI6N/NVCOH, TSANP, LFLRPI , LFLC6T, LFLKF , LTEVAL, LABORT 

10740s  COHNON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERN 

10750s  CONRON/ZNTX 1 /NVZN, ZNI d ) 

10740=  C0NN0N/ZNTX2/ZN2(1) 

10770s  COHNON/NOIND/NND, NRD, NPD, NND, NDD, NND, NNDD, NPLD, NNPNND, NNPR 

10780*  CONNON/NDIHC/NNG,NRC,NPC 

10790s  COMMON  /  CHDItT  X /NVCH ,  NENCH,NODC,CN(  l) 

10800=  COMMON/ LRE6P I  /L  X  ON,  LUD1I ,  LPHCL ,  LK  X  r  LKZ 

10810*  CONNON/CREBPI  /NVRP1 ,  RPK 1 ) 

10820*  C0NH0N/LC6T/LAU,LA13,LA21,LA23,LAI2,LA22,LKXAil,LKXA12,LKXAI3 

10830*  C0HH0N/CC8T /NVCBT , C6T  d ) 

10840=  IF(NEHCN)  20,20,15 

10850*  15  NSI ZE* (NND+2*NPD) * (NNC+NRC+NDD) 

10840*  IF(NSIZE.LE.NVC6T)  GO  TO  14 

10870s  NRITE  104, NSIZE 
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10880=  LABORT=NSIZ£ 

18898=  RETURN 


18988=  16  IFINND.6E.NNC)  SO  TO  17 

18918=  WRITE  187 

18928=  SO  TO  18 

18938=  17  IF  <NN0.6E.N0D)  60  TO  19 

18948=  WRITE  188 

18958=  18  LABORT-1 

18968=  RETURN _ 

I  18978=  19  NEWCH*8  1 

18988=  LAI 1=1 

18998=  LA13=LAU+NND*NNC 

11888*  LA21=LA13+NND*NDD 

11818=  LA23=LA21+NPD*NNC 

11828=  LA12=LA23+NPD*NDD 

11838=  LA22=LA12+NND*NRC 

11848=  LKXA1 1=LA22*WPDHWC 

11858=  LKXA12*LKXA11+NPD«NNC 

11068=  LKXA13=LXXA12+NPDtNRC 

11878=  CALL  C6TA1C6T (LAID , COT (LA13) ,C6T (LA21) ,C6T (LA23) ,C6T (LA12) , 

11088=  1  C6T(LA22),ZN1,ZH2) 

11090=  20  CALL  C6TKX (C6T (LAID ,C6T (LA13) , C6T (LA21) ,CST (LA23) ,C6T (LA12) , 

11108*  1  CST (LA22) |CST (LKXA1 1) ,C6T (LKXA12) , C6T (LKXA13) ,RPI (LKX) ) 

11118=  LFLCST*1 

11128=  106  FOHNAT 4 "8INSUFFICIENT  HENDRY  /COST/,  NEED:  ',14) 

11138=  107  FORNATC0FENER  DESIGN  HODEL  THAN  COHHAND  NODEL  STATES') 

11140=  188  FORHATl ‘FEWER  DESI6N  HODEL  THAN  DISTURBANCE  NODEL  STATES') 

11150*  RETURN 

11160=C  END  SUBROUTINE  SC6T 
11170*  END 

11188=  SUBROUTINE  C6TA(AU,A13,A21,A23,A12,A22,ZN1,ZH2) 

11198=  C0HH0N/NAIN1/N0IN,NDIN1,C0N1(1) 

11200=  C0HH0N/F1LES/KSAVE,KDATA,KPL0T,KLIST,KTERN 

11210=  COHHON/SYSNTX /NVSN, SH ( 1 ) 

11220=  CONNON/ND1HO/NND, NRD , NPD , NND, NOD , NWD, NWDD , NPLD, NWPNND, NNPR 

11238=  COHHON/LOCD/LAP, LBP, LPHI , LBD, LEX , LPHD, LO, LBN, LSD, LC, LDY, LEY, LHP, LR 

1 1 240*  CQHNON/DSNNTX/NVDH , NODY, NOEY, DN ( 1 ) 

11250*  CONHON/NDIHC/NNC,NRC,NPC 

1 1260=  CONNON/LOCC/LPHC, LBDC, LCC, LDC 

1 1270=  COHNON/CNDNTX/NVCN, NEWCH, NODC, CN ( 1 ) 

11280*  COHHON/LCNTRL/LP! 1 1 , LPI 12, LPI21 , LPI22, LPHOL, LBDL 

11290*  COHHON/CONTROL/NVCTL, CTL ( 1 ) 

11300=  DINENSION  A1 1 (1 ) , A13( 1) , A21 ( 1 ) , A231 1 ) , A12 (1 ) , A22( 1) , ZH1 U > , ZN2 ( 1 ) 

11310=  NDIN*NND 

11320*  ND2N1*NDIN+1 

11330*  CALL  TFRNTX(CH,ZN1,NNC,NNC,2) 

11340=  CALL  SUR;<ZN1,NNC,NDIN) 

11350*  CALL  FNHUL(CTL(LPU2),CHtLC0),NND,NRD,NNC,ZH2) 

11368*  CALL  HSCALE(ZN2,ZH2,NND,NNC,-1.) 

11370*  NB*HAX8(NDD,NNC) 

11380=  L2=1+NND*NND 

11390*  L3*L2+NND«NB 

11400=  L4=L3+NND*NB 

11410*  L5*L4+NND#NND 


11428  s  L6=L5+NND*NND 

11438s  NS I Z  E-L6+ W>D*NNC- 1 

11448s  IF (NSIZE.LE.NVSH)  GO  TO  1 

11458s  48RITE  102,NSIZE 

114 61s  182  FORMAT! ^INSUFFICIENT  HtMORY  /SVSHTX/,  NEED:  ",I4> 
11478s  LABORTsNSIZE 

11488s  RETURN 

11498s  1  CALL  AXBHXC (CTL (LPI 1 1 1 , NND, ZN1 , NNC, ZH2, A1 1 , SH, 

11588s  1  SN(L2) , SN(L3) , SH (L4) , SH (L5) ) 

11518s  CALL  NNUL ( A1 1 ,  ZH1 ,  NND,  NNC,  WC, ZN2) 

11528s  CALL  FHHUL(CTL(LPI21),ZH2,NPD,NND,NNC,A21> 

11538s  CALL  FHHUL (CTL (LPI22) ,CH(LCC)  ,NPD,NRD,NNC,SN(L6) ) 

11548s  CALL  FHHUL (All, CH(LBDC), NND,  )WC, NRC, SR) 

11558s  CALL  FHHUL(CTL(LPI11),SH,NND,NHD,NRC,A12) 

11560s  CALL  FHHUL (CTL (LP 121 ) , SR, NPD, NND, NRC, A22) 

11578s  IF(NODC.EO.l)  GO  TO  2 

11588=  CALL  FHmiL(CTL(LPI12},CH(L0C),NNDfHR0tNRCrSH(L2>) 

11598=  CALL  FNADD ( A12, SR(L2) , NND; NRC, A12) 

11608=  CALL  FRMJL ( CTL (LPI22) , CH(LDC) , NPD, NRD, NRC, SB (L2) ) 

11618=  CALl  FNADD! A22, SH (L2) , NPD, NRC, A22) 

11620=  2  IFINDD.EB.8)  SO  TO  15 

11638=  CALL  HHUL(CTL(LPI11),DH(LEX),KND,NND,NDD,ZN2) 

11640=  IF(NOEY.EB.l)  60  TO  5 

11658s  CALL  FHHUL(CTL(LPI12),DH(LEY>,NND,NRD,NDD,ZH1) 

11668=  CALL  HADD1(NND,N8D,ZH1,ZH2,ZR2,1.) 

11678=  5  CALL  TFRHTX(DM(LPM0),ZH1,N0D,NDD,2) 

11680=  CALL  SUBI(ZH1,NDO,NOIH) 

11698=  CALL  AX8HXC(CTL(LPI11),HW>,ZH1,NDD,ZH2,A13,SH. 

11788=  1  SH(L2),SR(L3>,SH(L4),SR(L5) ) 

11718s  CALL  HHUL(A13,ZM1,NND,NDD,NDD,ZH2) 

11728s  CALL  HAD01 (NND, HDD, ZH2, DM(LEX) , ZH2, -1. ) 

11738s  CALL  FHHUL (CTL (LP221 ) , ZR2, NPD, NND, NDD, A23) 

11748=  15  NDIH=NPD 

11758=  NDIH1=NDIH+1 

11768s  CALL  HADD1 (NPD, NNC, A21 , SH (16) , A21 , 1 . ) 

11778=  IF(NOEY.EB.l)  60  TO  28 

11780s  CALL  HHUL(CTL(LPI22),DH(LEY),NPD,NRD,NDD,ZH1) 

11798=  CALL  HADD1(NPD,NDD,A23,ZH1,A23,-1.) 

11888=  20  CALL  HATLST(A11,NND,NNC,*A11',KLIST) 

11818s  CALL  HATLST(A21,NPD,NNC, *A2l*,KLIST) 

11820=  CALL  RATLST(A12,NND,NRC, *A12*,KLIST) 

11838=  CALL  HATLST (A22,NPD,NRC, *A22*,KLIST) 

11840=  IF (NDD.6T.0)  GO  TO  25 

11850s  MRITE(KLIST,101) 

11860=  181  FORMAT  C8HATRICES  A13  AND  A23  ARE  ZERO*) 

11878s  RETURN 

11880s  25  CALL  HATLST (A13,NND,NDD,  *A13’  ,KLI!!T) 

11890=  CALL  HATLST (A23,NPD,NDD,  * A23\KLI!iT) 

11988=  RETURN 

U918*C  END  SUBROUTINE  C6TA 
11928=  END 

11930=  SUBROUTINE  AXBHXC(A,NA,B,NB,C,X,AU,BU,R.Z1,Z2) 

11940=  COHHON/HAIN1/NDIH,NDIH1,COH1 (1) 

11950=  CONHON/F ILES/KSAVE , KDATA, KPLOT , KL 1ST , KTERN 
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1196#*  DIMENSION  A(1),B(1),C(1),M),AU(1),BU<1),R(1),Z1<1),Z2(1> 

1197#*  DATA  EHAX, ITHAX/ 1 . E-6, 3/ 

11981=  CALL  TRANS1(NA,A,21) 

1199#*  CALL  EI6EN(NA,ZlfZ2,Z2INDIHl),AU,l) 

12###=  CALL  TRANS1(NA,C0H1,Z1) 

12111*  CALL  EI6EN(NB,B,Z2,Z2(NDIH1),BU,1) 

1202#*  CALL  EOUATE(R,C,NA,NB) 

12131s  IT*# 

1214#*  If  CALL  NAT4A(AU,R,NA,NA,N8,Z2) 

12050*  CALL  MT1  (Z2,BU,NA,NB,NB,R> 

12060*  CALL  SLVSHR(Zl,NAfC{mi,NB,R,NDIN) 

12171s  CALL  NAT4 (R, BU, NA, NB, NB, 22) 

12181s  CALL  NAT1(AU,Z2,NA,NA,NB,R) 

12#9f*  IF (IT. ST. I)  60  TO  15 

12111s  CALL  EfiUATE(ltR,NA,NB) 

1211#*  60  TO  3f 

12121s  15  CALL  NADD1(NA,NB,I,R,X,1.) 

12130s  CALL  ENORN(R,NA,NB,EN) 

12140s  IF(EN.LE.ElfAX)  RETURN 

12150s  IF(IT.LT.ITHAX)  60  TO  30 

12160s  MUTE  (KLIST,  101)  EN 

12170s  NRITE(KTERH,101)  EN 

12180s  101  FORMAT  C0SOLUTION  ERROR  FOR  ’A’ (COT)  AFTER  3  ITERATIONS  s  \1PE15. 
12190=  17) 

12200>  RETURN 

12210=  30  CALL  HATl(A,XfNA,NA,NB, Z2) 

12220s  CALL  HAT1(Z2IB,NA,NB,NB,R) 

12230s  CALL  HADD1(NA>NB,X,R,R,-1.) 

12240s  CALL  HADD1<NA,NB,R,C,R,1.) 

12250=  IT*IT*1 

12260s  60  TO  10 

12270«C  END  SUBROUTINE  AXBNXC 
12280=  END 

12290s  SUBROUTINE  SLVSMR(AINM,N8,C,N0) 

12300s  C0MMM/HAIN1  /NDIN,  NDIH1 ,  CONI  ( 1 ) 

12310=  COHNON/INOU/KIN,KOUT,KPUNCH 

12320s  DIMENSION  «(N0,1), BIND, 1),C(ND,1),V(16), M<4> 

12330s  L«1 

12340s  5  LH1*L-1 

12350s  DL*1 

12360=  IF(L.EO.NB)  60  TO  8 

12370s  IF(B(L+1,L).NE.0.)  DL>2 

12380s  8  LL=LM1+DL 

12390*  K=1 

12400s  10  KN1=K-1 

12410=  DK*1 

12420=  IF(K.EO.NA)  60  TO  12 

12430s  IF(A(K,K+1).NE.0.)  DK»2 

12440*  12  KMKHl+DK 

12450*  AKK*A(K,K) 

12460*  BLL*B(L,L) 

12470*  IF(DL.ES.2)  60  TO  35 

12480*  IF (DK.EB.2)  60  TO  20 

12490s  IF(L.EB.l)  60  TO  13 
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12588* 

C(K,L)*C(K,U-MK«DOnaMl,C(K,l),B(l,L)) 

12511*  13 

IF(K.EQ.l)  80  TO  18 

12S2f> 

DO  15  1*1,1011 

12531*  15 

C(K,L)3C(K,L)-A(K,1)*D0T3(L,C(1,1),B(1,L) ) 

12541*  18 

V(1)*AKK*BU-1. 

12551* 

IF (V ( 1 ) . EQ. 8. )  60  TO  99 

12568* 

C<K,L)«C1K,L)/V<1) 

12571* 

60  TO  95 

12588*  28 

IF(L.EQ«1)  60  TO  22 

12598* 

12688* 

12618* 

12628* 

I1*K 

I2*KK 

I3*LH1 

60  TO  24 

12638*  22 

IF(K.EO.l)  60  TO  38 

12648* 

11*1 

12658* 

I2*Kltl 

12668* 

13*1 

12678*  24 

DO  28  1*11,12 

12688* 

VU)*OOT3(I3,C<I,1),B(1,U> 

12698* 

C(K,L)*C(K,L)-A(K,I)*V(1) 

12788*  28 

C(KK,U*C(KK,L)-A(KK,l)>V(t) 

12718* 

IF(U.ED.K)  60  TO  22 

12728*  38 

V(l)*Att»BLL-l. 

12738* 

V  (2) =A(KK,K ) *BLL 

12748* 

V(3)*A(K,KK) *BLL 

12758* 

V(4)*A(KK  VK)*BLL*1. 

12768* 

V(5)*1./(V<1)*V(4)-V(21»V13)> 

12778* 

V(6)*V(5)«(C(K,LMV(4)-V<3)*CIKK,L)) 

12788* 

C(KK,L)*V(S)*(V(l)tC(KK,L)-V(2)*C(K,L)) 

12798* 

C(K,L)*V(6) 

12888* 

60  TO  95 

12818*  35 

1F(DK.E0.2>  60  TO  58 

12828* 

IF (L. EQ. 1 >  60  TO  38 

12838* 

I1*X 

12848* 

I2*K 

12858* 

13*1111 

12868* 

60  TO  48 

12878*  38 

IF(K.EO.l)  60  TO  45 

12888* 

11*1 

12898* 

12*1011 

12988* 

I3*U 

12918*  48 

DO  42  1*11,12 

12928* 

C(K,L)*€(K,L)-A(K,I)*D0T3(I3,C(I,1),B(1,L)) 

12938*  42 

C(K,LL)*C(K,LL)-A(K, I)*D0T3(I3,C(I,1),B(1,LL)) 

12948* 

IF(Il.EB.K)  60  TO  38 

12958*  45 

Vtl)*AKK*BLL-l. 

12968* 

V(2)*AKK*B(L,LL) 

12978* 

V(3)*AKK*l(LL,l) 

12988* 

V (4>  «AKK*B(LL, LL) -1 . 

12998*  48 

V(5)*1./1\M1)*V(4)-V12)»V(3>) 

13888* 

V16)*V<5)t(ClK,L)*V(4)-V(3)*C(K,LL>> 

13818* 

C(K,LL)*VI5)*<V(1)*C(K,LU-V(2)»C(K,L)) 

13828* 

C(K,L)*V(6) 

1314#*  59  IF(L.EQ.l)  80  TO  55 
13059s  V  ( 1  )sD0T3(Lltl  ,C(K,1),B(1,L)) 

13969*  V<2)=DQT3(LHl,C(KK,l),B(l,L) ) 

13979*  V<3)*B0T3(LH1,C<X,1),8<1,LL)> 

13989*  V<4)*D0T3(LH1,C1XX,1),8<1,LL)> 

13949*  C(X,L)*C!X,L)-AXK*V(1)-A(X,XK)*\M2) 

13199*  C<XXfL)*C(XX,L)-A<XX,X)*VU>-A<XK,XX)*V<2) 

13119*  C<X,LL)*C«fLL)-MXtV<3)-A(X,XX>tV<4) 

13129*  C(KX,LU*C<KK,LU-A(XK,K)«V(3)-A(KK,KK)*V(4) 

13139*  55  IF(X.EO.l)  SO  TO  65 
13149*  DO  69  I*1,XH1 

13159*  V(1)*D0T3{LL,C<I,1),B<1ID> 

13169*  V<2)*D0T3<LL,C<II1),8(1,LU> 

13179*  C(K,U*€(K,L)-A(K,1)»V(1) 

13189*  C(KX,L)*C(KKtU-A<KX,I)*V(l) 

13199*  C<X,LL)*C<X,LL)-A<X,I)*V(2) 

13299*  69  C(KKILU*€(KK,LL)-A(KK,1»V(2) 

13219*  65  V<1)*AKK*BLL-1. 

13229*  V(2)*A<XX,X)»BLL 

13239*  V<3)*AXX#B<L,LL> 

13249*  V(4)*A<XX,X)*B<L,LL) 

13259*  V(5)*A<X,XX)*BLL 

13269*  V(6)*A(XX,XX)«8LL-1. 

13279*  V(7)*A(K,KK)tB(L,LL) 

13289*  VI8)-A(XX,XX)#B(L,LL) 

13299*  V(9)*AXX*BUi,L) 

13399*  VU9>«A(KX,X)*B<LL,L) 

13319*  V(U)*AXX#B(LL,LL)-1. 

13329*  V<12)*A(KK,K)tB(LL,U.} 

13339*  VU3)«A(X,XX)*B<LL,L) 

13349-  VU4)*A<KKlKK)iB(lL,L) 

13359-  V(15)*A(K,KK)*B(LL,LL) 

13369*  V<16)*A<XXfXX)«8(LL,LL>-l. 

13379*  H(l)*C(K,l) 

13389*  H12)*C(KK,U 

13399*  N(3)*C(X,LU 

13499*  IM4>*C(XX,LL) 

13419*  NDS-NDIH 

13429*  NDW*4 

13439*  NDIH1»NDIH*1 

13449*  CALL  00GLIT(4,V,H,1,IS6) 

13459*  NDIH*NDS 

13469*  NDIH1*NDIH+1 

13479*  95  X*X*DX 

13489*  IF(X.LE.NA)  60  TO  19 

13499*  L«L*DL 

13599*  IF(L.LE.NB)  GO  TO  5 

13519*  RETURN 

13529*  99  MUTE  (KOUT,  191) 

13539*  RETURN 

13549*  191  FORMAT! *9«  t  #  ERROR  IN  C6T  SOLUTION:  AU->A23*> 
13559*C  END  SUBROUTINE  SLVSHR 
13569*  END 

13579*  SUBROUTINE  ENORH(A,NR,NC,ENRH) 
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13381*  COmON/NAlNl/NDIR, MINI, COM  ID 

13591*  DIMENSION  All) 

13AM*  ENRH-9. 

13619*  N£*NC»NDIH 

13629*  90  1#  1*1, NR 

13631*  DO  If  J*I,NE,NOIH 

13641*  If  ENRR*ENRH+AIJ)*AIJ) 

13651*  ENRN*S8RT (ENRH) 

13669*  RETURN 

1367f*C  END  SUBROUTINE  ENORH 
13681*  END 

13699*  SUBROUTINE  C8TKX(A11,A13,A21,A23,A12,A22,RKXAU,RKXA12,RKIA13,RKX) 

13799*  C0HN0N/NAIN1/N0IN,  MINI,  CONI  (1) 

13719*  COWm/F  ILES/KSAVE,  KDATA,  KPLOT ,  KL I  ST  y  KTERM 

13721*  COHHON/NDIHD/NND, NRD,NPD, NHD, NOD, NMD, NNDD, NPLO, NNPNND, NNPR 

13739*  COHHON/NDINC/NNC,NRC,NPC 

13749*  OIMENSION  A11(1),A13(1),A21(1),A23(1),A12(1),A22(1), 

13759*  1  RXXA11 (1>,RXXA1241),RKXA13(1> ,RKX ID 

13769*  NDIiMKD 

13779*  NDIHl-NDIH*! 

13789*  CALL  FNHUL(RKX,A11,NRD,NN0,NNC,RKXA11) 

13799*  CAU  NA0D1(NRB,NNC,RKXAU,A21,RKXA11,1.) 

13899*  CALL  NATLSTlRKXAll, NAD,  NNC,aMH*, KLIST) 

13819*  CALL  NATLST(RKXAU,NRB,NNC,aKXR*,KTERN) 

13829*  CAU  FMHUL(RKX,A12,NRB,NND,NRC,RKXA12) 

13839*  CALL  NAB01(NR0,NRC,RKXA12,A22,RKXA12.1.) 

13849-  CAU  NATLST1RKXA12, NRD, NRC,aKXUa, KLIST) 

13859*  CAU  MTLST(RKXA12,NRB,NRC,*KXUa,KTERH) 

13869*  IF(NM.LT.l)  RETURN 

13879*  CAU  FHHUL(RKX,A13.NRD,Nlffl,MDD,RKXA13> 

13889*  CAU  HAM1  (NRD, NDD,RKXA13, A23, RKXA13, 1 . ) 

13899*  CAU  NATLST (RKXA13, NRD, lfl)D, aKXNa, KLIST) 

13999*  CAU  NATLST(AKXA13,NRD,NDD,aKXNa,KTERH) 

13919*  RETURN 

139294  END  SUBROUTINE  CSTKX 

13939*  ENB 

13949*  SUBROUTINE  CEVAL 

13959*  COmON/HAIRl/NDIN,NDm,COm(l) 

13969*  COHHON/INOU/KIN,KOUT,KPUNCH 

13979*  C0HH0N/DESI6N/NVC0H, TSAHP, LFLRPI , LFLCGT , LFLKF , LTEVAL , LABORT 

13989*  COHHON/FILES/KSAVE, KDATA, KPLOT, KLIST , KTERH 

13999*  C0HH0N/8YSHTX/NVSH,SH(1) 

14999*  CflHHON/ZNTXl/NVZH,  ZH1  ( 1 ) 

14919*  C0HMM/ZNTI2/ZH2(1) 

14929*  CONMM/NDIHD/NNB,  NRD,  NPB,  NHD,  NOD,  NND,  NNDD,  NPLD,  NNPNND,  NNPR 

14939*  COMNM/»IHC/NNC,NRC,NPC 

14949*  C0HH0N/LRE6PI/IXDN,LUDN,LPHCL,LKX,LKZ 

14959*  C0HH0N/CRE6PI/NVRPI,RPI(i) 

14969*  DIHENSION  NP10T(2),RVPL0T(19),NS(6),LSCL(2),ITITLE(S) 

14979*  DATA  N0/1HN/ 

14989*  NRITE (KLIST, 119) 

14999*  119  F0RHAT(////llX,5(a*  a), 'CONTROLLER  EVALUATION*, 5(a  #*)////) 

14199*  IPOLE-1 

14119*  19  NV0UT«NRD*NPD*1 


14121* 

14131*  13 

14141* 

14131* 

14161* 

14171* 

14181* 

14191* 

142M*  17 

14211* 

14228*  18 

14231* 

14248*  28 

14238* 

14268* 

14278*  23 

14288* 

14298* 

14388* 

14318* 

14328* 

14338* 

14348*  26 

14338* 

14368* 

14378* 

14388* 

14398* 

14488* 

14418* 

14428* 

14438-  28 

14448* 

14438* 

14468* 

14478* 

14488* 

14498* 

14388* 

14318* 

14328* 

14338* 

14348* 

14338* 

14368*  38 

14378* 

14588*  33 

14398* 

14688*  48 

14618* 

14628* 

14638* 

14648* 

14658* 


IF(LFLC6T)  17,17,15 
MITE  186 
READ*,IUN,VUN 
IF(IUH.LT.l)  60  TO  78 
IF(IUM.6T.NRC)  60  TO  15 
NVOUT*NVOUT*NPC 
NP*NNC 
60  TO  18 

IF(IPOti.EO.l)  CALL  POLES (RPI (LPHCL) , NNPR, 4, ZM1 , ZH2) 

NP*8 

CALL  VOUTIC (8N,NVPL0T, NPLOT , NVOUT, LSCL) 

IF (NVOUT. EB.f)  60  TO  78 

MITE  188 

READ«,TEND 

IF (TEND)  28,28,23 

LVX8*NV0UT+1 

LX8*LVX8+NV0UT 

LX1-LX8+NPLD 

LXH8=LX1+NPLD 

LXH1*LXH8+NP 

NP*LXH1+NP 

DO  26  I*LVX8,NP 

SRII>*8. 

CALL  CT8ESP(SN(LVX8),SH,SH(LX8),SN(Ln),SH(LIIW),SN(LXRl), 
1  ZH1, NVOUT, TEND, IUN, VUN, N8T) 

MITE  (KTENN,  181) 

READ (KIN, 182)  ITITLE 

H*38«NST 

DO  48  1*1,2 

NS(1)*1 

DO  28  3*2,6 

NS(J)*NS(J-1)+51 

NP*NPLOT(I) 

IF (NP. Efi.8)  60  TO  48 
NPPl*NP*l 
REMIND  KPLOT 
NSV*5»I-4 

CALL  RPLOTFIZHl, NVOUT, IERR) 

CALL  STRPLT(SH,ZN1, NS, NVPLOT(NSV),NP, NVOUT) 

DO  33  3*1, H 

CALL  RPLOTFIZHI, NVOUT, IERR) 
lF(IERR.EO.l)  60  TO  48 
IF(H0D(3,NST).NE.8)  60  TO  33 
DO  38  K*1,NPP1 
NS(K)*NS(K>+1 

CALL  STRPLT (SH, ZH1,NS,NVPL0T (NSV) ,NP, NVOUT) 

CONTINUE 

CALL  PL0TLP(31,NP,SN,LSCL(I),1, 8, KTERN, ITITLE) 

CONTINUE 

NVN*NVOUM 

N*NVH/3 

NE*5*N 

IF (H.EQ.f )  60  TO  36 
DO  53  1*1,  NE,  5 

D-37 
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1466#*  NSU)*1 

14671*  DO  42  J*2,6 

1468#*  42  NS(J)*NS<J-1>*1#1 

1469#*  REWIND  KPLOT 

147##*  NVS*I-1 

1471#*  DO  45  J*l,5 

1472#*  45  NVPLOT(I)*NVS+J 

1473#*  00  5#  J*l,l#l 

1474#*  CALL  RPL0TF4ZH1, NVOUT, IERR) 

1475#*  IF(IERR.EQ*1)  60  TO  55 

1476#*  CALL  STRPLT (SN,  ZH1 ,  NS, NVPLOT, 5, NVOUT) 

1477#*  00  48  K»l,6 

14788*  48  NS(K)*NS(KM 

147?#*  5#  CONTINUE 

148##*  CAU  PL0TLP<1#1,5,SH,1,I,1,KLIST,ITITLE> 

1481#*  55  CONTINUE 

1482#*  56  NVH*ftVIHE 

1483#*  IF(NVN.LT.l)  60  TO  7# 

1484#*  NPP1*NVH+1 

1485#*  NS(1)*1 

1486#*  00  57  1*2,6 

1487#*  57  NSII)*NS(I-1)*1#1 

1488#*  DO  58  1*1, NVH 

1489#*  58  NVPLOT (I)=NE*I 

149##*  REWIND  KPLOT 

1491#*  DO  65  1*1,  HI 

1492#*  CALL  RPLOTFIZHI, NVOUT, IERR) 

1493#*  IF(IERR.EB.l)  60  TO  7# 

1494#*  CALL  STRPLT(SN,ZN1, NS, NVPLOT, NVH, NVOUT) 

1495#*  DO  6#  J*1,NPP1 

1496#*  6#  NS(J)*NS(J)*1 

1497#*  65  CONTINUE 

1498#*  CALL  PL0TLP(1#1,NVH,SH,1,1,1,KLIST,ITITLE) 

1499#*  7#  WRITE  114 

IS###*  READ  111, IANS 

15#1#*  IFdANS.E8.N0)  RETURN 

1502#*  I POLE*# 

13#3#*  60  TO  1# 

15#4#»  lfl  FORHATC  ♦■,!#<•-•),•  ENTER  TITLE  IN  GIVEN  FIELD  M#<,-*),'+V) 
15#5#»  1#2  FORMAT (5A1#) 

15(6#*  104  FORHATffHORE  TINE  RESPONSE  RUNS  (V  OR  N)  >') 

1307#*  1#6  FORMAT ( “0ENTER  MODEL  INPUT  AND  STEP  VALUE  :  1  >*) 

15080*  t#8  FORMAT (*  ENTER  TINE  DURATION  FOR  RESPONSE,  IN  SECONDS  >') 

15090*  111  FORMAT (A3) 

131##*C  END  SUBROUTINE  CEVAL 

1511#*  END 

1512#*  SUBROUTINE  VOUTICWIC, NVPLOT, NPLOT, NVOUT, LSCL) 

1313#*  COMMON/ DESI6M/NVC0H, TSANP, LFLRPI, LFLC6T,LFLKF,LTEVAL, LABORT 

1514#*  COHMON/F I LES/KSAVE , KDAT A, KPLOT , KL I ST , KTERH 

1315#*  COHHON/NDIHD/NND, NRD, NPD, NMD, NDO, NND, NNOO, NPLD, NNPNND, NNPR 

1516#*  COHHON/NDIHC/NNC,NRC,NPC 


1517#*  C0HH0N/NDlHT/NNT,NRT,MIT,NNT 

1518#*  DIMENSION  NPL0T(1),NVPL0T(1),VIC(1),I0UT(5),LSCL(2) 

1519#*  DATA  IOUT/IHI, 1HY, 1HU, 1HH. 1HD/ 


« 


152##*  IF(LTEVAL)  2,2,5 

13211s  2  NVS-NND 

1522#*  NV*NPLD 

15231*  60  TO  8 

15241*  5  NV-NNT 

15251*  NVS*NV 

1326#*  6  NVOUT*NVOUT+NV 

13271*  DO  ?  I*1,NV0UT 

15281*  9  VIC(I)*I. 

13291*  NVU-NV+NPD 

153##*  NVM-NVU+NRB 

1531#*  II  MITE  lfl.NVS 

1532#-  111  FORMAT (aIENTER  STATE  AND  !C  VALUE  (•/  TERMINATES) :  \I2,a  >*) 

1333#*  12  READ«,IV,V 

15341-  IF  f IV. LT. 1)  60  TO  15 

13331*  IFUV.6T.NVS)  60  TO  1# 

1536#-  VIC(IV)*V 

15371*  60  TO  12 

13381*  13  IF ( (LFLC6T. LT. 1 ) . OR. (LTEVAL . EO. 1 ) . 08. (NDD.LT. 1 ) )  GO  TO  25 

1339#*  LD*1 

154##*  18  MUTE  112, NDD 

13411-  1#2  FORMAT (a  ENTER  DISTURBANCE  IC  VALUE  (•/  TERMINATES):  a,I2,a  >*) 

15421*  2#  READ*, IV, V 

1543#*  IF(IV.LT.l)  60  TO  26 

15441*  IFdV.6T.NDD)  60  TO  18 

1545#-  VIC(NND+IV)«V 

1546#*  60  TO  2# 

1547#-  23  LD-# 

15481-  26  MUTE  1#3 

1549#-  113  FORMAT (a  2  PLOTS  OF  3  VARIABLES  NAY  BE  PRINTED  AT  THE  TERMINAL  - 
135##*  1 SPECIFY  NUMBER  FOR  EACH  <N1,N2)  >*) 

15311*  READ*, NPLOT  d ) , NPLOT (2) 

1532#-  IF(NPL0Td).6T.3)  NPL0T(1)>5 

15331*  IF (NPLOT (2) .6T. 3)  NPL0T(2)-3 

1354#*  IF( (NPLOTd) .6T.I) .OR. (NPLOT (2) .6T.I) )  60  TO  27 

1333#*  NVOUT*# 

1336#*  RETURN 

1337#-  27  MUTE  1#4 

1358#-  114  FORMAT (a  ENTER  OUTPUTS  BY  TYPE  AND  INDEX  IN  2  ENTRIES— TYPES  ARE"/ 
1559#*  1  a  STATE  :  ’X,a/a  OUTPUT  :  *Y ,a/a  INPUT  :  ’U’a) 

156##-  IF4LFLC6T)  31,31,28 

1361#-  28  MUTE  115 

1562#*  ifS  FORMAT (a  MODEL  :  ’H,a) 

1563#*  IF(LO.EB.l)  MUTE  116 

1364#*  1#6  FORMAT (a  DISTURBANCE  :  ’D,a) 

1365#-  31  DO  4#  1-1,2 

1566#-  NC-NPLOTtI) 

15671*  IFINC.LT. 1)  60  TO  4# 

1568#*  LSCL(I)*1 

1369#*  NS*5*d-l) 

1579#*  MUTE  1#7,1 

1371#*  117  FORMAT ("IPLOT  a,I2) 

15721-  DO  39  3*1, NC 

1373#*  NSP-N8+J 


v:  vn>’-x 
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15741*  31  MITE  188,  J 

15751*  lf8  FQRNATC  OUTPUT  M2,"  >*) 

15761*  READ  111, IV 

15771*  MITE  113 

15781*  113  FORHATdlX/)1) 

15798*  READ*, 10 

15888*  IFdV.NEJOUTd))  80  TO  32 

13818*  IFdO.6T.MVS)  SO  TO  38 

15828*  MVP10TIMSP)*!Q 

15838*  60  TO  39 

13848*  32  IFdV.NE.  I  OUT  (2))  60  TO  321 

13858*  IFdO.ST.NPD)  60  TO  38 

13868*  NVPlOT(NSP)*NVdQ 

15878*  60  TO  39 

15888*  321  IFdV.NE.  IQUT(3)>  60  TO  33 

15898*  IFdO.6T.NRD)  60  TO  38 

15988*  NVPLQT(NSP)*NVUdO 

15918*  60  TO  39 

15928*  33  IF (LFLC6T . LT. 1 )  60  TO  31 

15938*  IFdV.K. I0UTI4))  60  TO  34 

15948*  IFdO.6T.NPC)  60  TO  38 

15938*  NVPLOT(NSP)*NVH+IO 

15968*  LSCLd)«-l 

15978*  60  TO  39 

15988*  34  IF(LO.NE.l)  60  TO  31 

15998*  IFdV.NE.  IOUT (3))  60  TO  31 

16888*  IFdO.6T.NDD)  60  TO  38 

16818*  NVPIOT INSP) *NVS+IO 

16828*  60  TO  39 

16838*  38  MITE  189 

16848*  189  FORMAT 1*  INDEX  TOO  LAR6E*) 

16858*  80  TO  31 

16868*  39  CONTINUE 

16878*  48  CONTINUE 

16888*  NVH1*NV0UT-1 

16898*  NP*8 

16188*  DO  58  I*lfNVMl 

16118*  M*M0DdI-l),5)*l 

16128*  IF1H.6T.1)  60  TO  41 

16138*  NP*NPd 

16148*  MITE  (HIST,  118)  NP 

16158*  118  FORMAT  C8P10T  M2) 

16168*  41  IFd.6T.NV8)  60  TO  42 
16178*  IV*IOUTd) 

16188*  10*1 

16198*  60  TO  43 

16288*  42  IFd.6T.NV)  60  TO  43 

16218*  IV*IOUT  <5) 

16228*  IO*I-NVS 

16238*  60  TO  45 

16248*  43  IFd.6T.NVU)  60  TO  441 

16258*  IV*10UT<2) 

16268*  IO*I-NV 


1 


1628#*  441  IF(I.6T.NVM)  60  TO  44 

1629#*  IV*IOUT (3) 

1631#*  I0*1-NVU 

1631#*  60  TO  43 

1632#*  44  IV*I0UT<4) 

1633#*  IQ*I-NVN 

1634#*  43  MITE  (KLIST,  112)  H,IV,IO 

1633#*  5#  CONTINUE 

1636#*  RETURN 

1637#*  111  FORMAT(Al) 

1638#*  112  FORMAT (*  OUTPUT  *,A1, 12) 

1639#*C  END  SUBROUTINE  VOUTIC 

164##*  END 

1641#*  SUBROUTINE  CTRESP<VX#,VIlf)!#fIl,ZN«,INl,ZNl,NVOUT,TEND,IUH,VUN, 

1642#*  I  NST) 

1643#*  C0MM0N/DESI6N/NVC0M, TSAMP, LFLRPI , LFLC6T, LFLKF, LTEVAL , L ABORT 

1644#*  COHHQN/FILES/KSAVE, KDATA,KPLOT ,  KLIST, KTERH 

1643#*  CQHHON/NDIND/NND,  MB,  MD,  NMD,  NOD,  NND,  NNOD,  NPU),  NNPNND,  NNPR 

1646#*  COmOM/LOCO/LAP,  L6f»,  LPH1 ,  LBOf  LEX ,  LPHD,LS,  LBN,  LflOt  LC,  LOY ,  LEY,  LHP.  LR 

1647#*  C0MM0N/DSNMTX/NVDH.N0DY,N0EY,DN(1> 

1648#*  COHMON/NDIHC/NNC,NRC,NPC 

1649#*  COHHON/LOCC/LPHC, LBDC, LCC, LOG 

165##*  C0HH0N/CMDMTX/NVCH,NEWCN,NQDC,CH(1) 

1651#*  COHNON/LOCT /LPHT, LBDT, LflDT , LHT , LRT, LTDT.LTNT 

1652#*  C0HH0N/TRUHTX/NVTH,TNI1) 

1653#*  C0HHGN/LRE6PI  /LIDN, LUDN , LPHCL,  LKX , LKZ 

1634#*  C0NN0N/CRE6PI /NVRPI , RPl ( 1 ) 

1655#*  DIMENSION  VX#<l)fVXl(l),X#U)fXl(l>,XM#(l),XHl(l)fZMHl) 

1636#*  NSTP0».#1#TEND/TSANP*.5 

1657#*  NST*2 

1638#*  IF(NSTP0.6E.l)  60  TO  1 

1659#*  NSTPO-1 

166##*  NST*1 

1661#*  1  NSTEPS*1##*NSTP0 

1662#*  IF(LFLCST.EB.f)  60  TO  2 

1663#*  LMO*NVOUT-NPC 

1664#*  IFtNDD.Efl.#)  60  TO  4 

1663#*  LDC6T-1 

1666#*  60  TO  3 

1667#*  2  UNWNOUT 

1668#*  4  L0C8T*# 

1669#*  3  L1M.H0-NRD 

167##*  LSO*lU-NPD 

1671#*  NVX*LS0-1 

1672#*  IF(LTEVAL)6,6,1# 

1673#*  6  DO  7  1*1, NVX 

1674#*  7  X1(I)*VX1II) 

1673#*  60  TO  12 

1676#*  1#  CALL  XFDT(VX1,X1,LDC6T) 

1677#*  12  NNDP1-NNIH1 

1678#*  REWIND  KPLOT 

1679#*  CALL  YDSN(X1,VX1 (LU) ,DN(LC) , DM(LDY) ,LDC6T, VX1 (ISO) ) 

168##*  IF0FIC8T.EB.1)  CALL  YCND(XH1,IUM,VUN,CH(LCC),CR(LDC), 

1681#*  1  VXHLMO)) 
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16821*  CALL  MPLoTr (VXlf MVOUT) 

16831*  DO  Iff  IT* INSTEPS 

16848*  CALL  URPI (RPI tLKX) f RPI (LKZ) , DH(LC) ,0H(L0Y) ,X0, Xlf VXi(LU) y VX1 (LU) ) 
16838*  ■  IF(LFLCBT)  28,28,13 

16868*  13  CALL  UC6T 4 VX8 ILU) , VX1 <LU) , XH8, XH1 , X8 (NNDP1 > , ZH1 , !UHf  VUNf IT ) 

16878*  CALL  CUPDAT  (XH8,  XH1 ,  IU(ty  VUH) 

16888*  28  CALL  FTHTX(VXl(LU),VX8<LU),HRDtl) 

16898*  CALL  FTNTIII1,I8,NPLD,1) 

16988*  IF(LTEVAL)  23,23,38 

16918*  23  CALL  DUPDAT(M(LPH1),DH(LBD),DN(LPHD),DH(LEI),ID,I1, 

16928*  1  VII , VID(LU) , LDC6T, NNDP1 ) 

16938*  60  TO  35  1 

16948*  38  CALL  TUFDAT<TX<LPHT),Tll(LBDT),VI8,Vn,VI8(LU)) 

16938*  CALL  !FDT(V!1,I1,LDC6T> 

16968*  33  IF(NOD(IT,NSTPO).NE.8>  60  TO  IN 
16978*  VI 1  (MVOUT)  *TSANP«FLDAT  (IT) 

16988*  CALL  Y0SN(X1,VX1 (LU) ,DH(LC) tDN(LOY) ,LDC6T,VX1 (LSOH 

16998*  IF (LFLC6T. EB.  1 )  CALL  YCKXXHI v  IUH, V(Jlf,CH(LCC) ,CM(LOC) , 

17888*  1  VII  (LIW)  > 

17818*  CALL  HPLOTF ( VII , NVOUT) 

17828*  IN  CONTINUE 


17838* 

17848* 


ENDF1LE  KPLOT 
RETURN 


17858=C  END  SUBROUTINE  CTRESP 
17868*  END 

17878*  SUBROUTINE  DUPDAT(PHI,BD,PNID,EI,I8,I1,VI1,U8,LDC6T,NNDP1) 

17888-  COmON/MINl/NOIN,NOIHl,CONl(l) 

17898*  COIMON/NIND/NND^D^DfNNDfNDDfNND^DDfNPLD.NIIPtWD.KNPR 

17188*  DINENSION  PHI(1),BD(1),PH!0(1),EI(1), 18(1), 11(1), VI1(1),U8(1) 

17118*  NDIIMMD 

17128*  NDIHl-NDIHH 

17138*  CALL  FHNUL(BD,U8,NN0, 1018,1,11) 

17148*  CALL  HNULS(PHI,I8,NND,NND,1,I1) 

17158*  IF(LDC6T.EB.8)  60  TO  18 

17168*  CALL  FNNUL(PHID,I8(NNDP1),NDD,NDD,1,I1(NNDP1)) 

17178*  CALL  HNULS(EI,IHNNDP1),NND, HDD,  1,11) 

17188*  18  CALL  FTNTI(I1,VI1,NPLD,1) 

17198*  RETURN 


172N*C  END  SUBROUTINE  DUPDAT 
17218*  END 

17228*  SUBROUTINE  CUPDAT(IH8,IH1,IUH,VUN) 

17238*  CONHON/NAINl/NDIN,NOIHl,COfll(t) 

17248*  CONMN/NDIHC/NNC,NRC,NPC 

17258*  COMNON/LOCC/LPNC, LBDC , LCC, LDC 

17268*  CONHON/CnNTI/NVC)l,NENCN,NODC,CH(l) 

17278*  DINENSION  IN8(1),IN1(1) 

17288*  NDIH*NNC 

17298*  NDIN1*NDIIH1 

173N*  CALL  FTHTI(IN1,IN8,NNC,1) 

17318*  L1*LADDR (NNC, 1 , I UN) +LBDC-1 

17328*  CALL  VSCALE(1H1,CN(L1),NNC,VUR) 

4/  ’38*-  CALL  mULS(CH(LPHC),IN8, NNC, NNC, 1, INI) 

:/348*  RETURN 


17338*C  END  SUBROUTINE  CUPDAT 


l 


17341s  END 

1737#*  SUBROUTINE  TUPDAT (PHI f 80, VXf, VX1 , US) 

17381*  C0HH0N/HAIN1/NDIH, NDIH1 , CONI ( 1 ) 

1739#*  COMHOM/NDIHT/NNT,NRT,NHT,NNT 

174##*  DIMENSION  PHI(1),BD<1),VI#(1),VX1U),U#U) 

1741#*  NDIH*NNT 

1742#*  NDIHl-NDIH+1 

1743#*  CALL  FTHTX<VI1,VX#,NNT,1) 

1744#*  CALL  FHMUL(BDfUlfNNT,N8Tf !|VX1) 

1743#*  CALL  HHULS4PHI, VX«, NMTyNMT, 1,VX1) 

1744#*  RETURN 

1747#*C  END  SUBROUTINE  TUPDAT 
1748#*  END 

1749#*  SUBROUTINE  XFDT(V,I,LDCBT) 

175##*  CONHON/NDIHD/NND,  NRD, NPD, NHD, NDD, NMD, NNDD, NPLD, NNPNND, NNPR 

17311*  COMON/NDIHT/NNT,  NRT,  NHT,  NNT 

1732#*  COHMON/LOCT/LPHT, LBDT.LBDT, LHT, LRT, LTDT,LTNT 

1733#*  COHHON/TRUHTll/NVTH, TH( 1 ) 

1754#*  DIMENSION  V<1),I(1) 

1755#*  CALL  FHMJL(TH(LTDT) , VfNNSyNNTy lf  X) 

1754#*  IF(LDC6T.EB.#>  RETURN 

1757#*  CALL  FHHUL<TN<LTNT),V,NDD,NNT,1,](<NND+1>> 

1758#*  RETURN 

1759#*C  END  SUBROUTINE  XFDT 
174##*  END 

1741#*  SUBROUTINE  URPI (RKX, RKZ, Cy DY, X#, X i , U#,Ui ) 

1742#*  C0NH0N/HAIN1/NDIH,NDIM1,C0N1(1) 

1743#*  CQHMN/NDIHD/NNO,  NRD,  NPD,  MID,  NDD,  HMD,  NNDD , NPLD , NNPNND,  NNPR 

1744#*  DIMENSION  RKX 4 1 ) f RKZ <1 ) ,C( 1) , DY< 1 ) , X#( 1) , XI (1 > , U# (I ) , U1 41 ) 
1743#*  CALL  YDSN(X#,Uf,C,DY,#,UH 

1744#*  1#  CALL  VSCALE<U1,U1,NRD,-1.) 

17470-  CALL  NNULS(RKZ,U1,NRD,NRD,1,U«) 

1748#-  DO  12  1*1, NPLD 

1749#*  12  X#U)*I#CIHUI1> 

177##*  CALL  FMHUL(RKX,X#,MRD,NND,1,U1) 

1771#*  CALL  VADD(NRD,1.,U1,U#>  ' 

1772#*  RETURN 

1773#*C  END  SUBROUT  IK  URPI 
1774#-  END 

1773#*  SUBROUTINE  UC6T<U#,U1,XH#,XH1,DDIF.ZH1,IUH,VUH,IT) 

1774#*  C0MM0N/NAIN1/NDIH, NDIM1 , COni (1) 

1777#*  COHRON/NDIMD/NND, NRD, NPD, NHD, NDD, NND, NNDD, NPLD, NNPNND, NNPR 

1778#*  COMMON/NDIHC/NNC,NRC,NPC 

1779#*  COHMON/LOCC/LPHC, LBDC, LCC, LDC 

178##*  COMMM/CMOHTX/NVCM,  NENCH,  NODC,  CM  ( 1 ) 

1781#-  COIMON/LREBPI /LXDN,LUDN, LPHCL, LKX , LKZ 

1782#*  C0MM0N/CRE6PI/NVRPI,RPI(1) 

1783#*  C0MN0N/LCST/LA1 1 , LA13, LA21 , LA23, LA12.LA22, LKXA1 1 , LKXA12, LKXA13 

1784#*  C0MH0N/CC8T/NVC8T,C6T ( 1 1 

1785#*  DIMENSION  U#<i),UlU),XH#m,XHl(l>.DDIF(l),ZHl(l) 

1784#*  CALL  YCMD1XM#, IUM,VUM,CH(LCC),CH(LDC),Uf) 

1787#*  IFlIT.ST.l)  60  TO  1# 

1788#*  I*LKXA12+LADDR<NPD,1,IUH)-1 


1789#*  CALL  HADDHNPD,1,U1,CSTU),U1,VUH> 


17911*  If  CALL  NHULS(RPKLKZ)  ,U8,NDIH,NDIH,1,U1) 

1791#*  DO  12  1*1, NNC 
17921*  12  XH8(I)*XHl(I)-XH8(l) 

17931*  CALL  FBIflJL (C8T (LKXAi 1 ) , XM8, NPD, NNC, 1 , U§) 

17941*  CALL  VADD<NDIH,1.,U1,U8> 

1795#*  IF (NDD.EB.f )  RETURN 
1796#-  DO  14  1*1, NDD 
17971*  14  DOIF ( I ) *-DDIF II) 

17981*  CALL  MULS(C6T<UXA13),DD1F,NPD,NDD,1,U1) 

17991*  RETURN 

18Mf*C  END  SUBROUTINE  UC6T 
18111*  END 

18821*  SUBROUTINE  YDSNU,U,C,D,LDC6T,Y) 

18131*  CONMN/NAINl/NDIN,NDINl,COHl(l) 

18148*  COMON/NDIND/NND,  NRD,  NPD,NND,NDD,  NMD,  NUDD,  NPLD,  NMPNMD,  NNPR 
18838*  COHHQN/LOCD/LAP, L6P, LPHI , LBD, LEX , LPHD, LO, LBN, LSD, LC, LDY, LEY, LHP, LR 
18868*  CONHON/DSNNTX/NVDN, NODY, NOEY, DM ( 1 ) 

18878*  OINENSION  X 1 1 ) , UU  >  ,C  <1 ) ,  0  ( 1 )  f  Y  <  1  > 

18888=  NDIN*NPD 

18898=  NDIH1*NDIH4>1 

18188*  CALL  FHMJL(C,X,NPD,NND,i,Y> 

18118*  IF(NOBY.Efl.l)  60  TO  18 

18128*  CALL  HMLS(D,U,NPD,NRD,1,Y> 

18138*  18  IFULOCGT.EB.Bl.OR. (MEY.EB.D)  RETIRN 
18148=  CALL  imS(DH<LEY),X<NND*l),NPD,NDD,l,Y) 

18138*  RETURN 

1816#=C  END  SUBROUTINE  YDSN 
18178*  END 

18188*  SUBROUTINE  YCHD(X,IU,VU,C,D,Y) 

18198*  COMMN/IMINI  /NDIH,  NO  INI ,  CONI  { 1 ) 

18288*  COHHON/NDIHC/NNC,NRC,NPC 

18218*  C0NH0N/Q1DHTX/NVCN,NENGN,N0DC,CN(1) 

18228*  DIMENSION  X(1),C(1),D<1),YI1) 

18238*  NDIN*NPC 

18248*  NDIHI=NDIH+1 

18238*  CALL  FHHUL(C,X,NPC,NNC,l,Y> 

18268*  IF (NODC.EB. 1)  RETURN 

18278*  L1*LADDR(NPC, 1,IU) 

18288*  CALL  NADD1(NPC,1,Y,D(L1),Y,VU) 

18298*  RETURN 

18388-C  END  SUBROUTINE  YCMD 
18318*  END 

18328*  SUBROUTINE  FLTRK(IFLTR) 

18338*  CONNON/HAIN1/NDIN,NDIN1,COH1(1) 

18348*  CQMON/HAltt/COIGU) 

18338*  CONNON/DESI6N/NVCON, TSAHP, LFLRPI , LFLC6T, LFLKF, LTEVAL, LABORT 
18368*  CONHON/FILES/KSAVE, KDATA,KPLOT, KLIST, KTERM 
18378*  COHMON/SYSHTX/NVSN, SH ( 1 ) 

18388*  COHNON/ ZNTX 1 /NVZHf  ZH1 ( 1) 

18398*  COMMON/ ZHTX2/ ZH2 ( 1 ) 

18488*  COMON/NDIND/NND, NRD, NPD, NHD, NDD, NND,NNDD, NPLD, NNPNND, NNPR 
18418*  COHHON/LOCD/LAP, L6P, LPHI, LBD, LEX, LPHD, LB, LBN, LBD, LC, LDY, LEY, LHP, LR 
18428*  CONNON/DSNNTX/NVDfl, NODY , NOEY, ON ( 1 ) 

18438*  COHHON/LKF /LEADSN , LFLTRK , LFCOV 


1844#*  COHHON/CKF/NVFLT, FLT ( 1 ) 

1845#*  IF!NNPNND.6T.4)  SO  TO  i 

18444*  MITE(KTERH,  148) 

1847#*  1#8  FORMAT ("4N0  DRIVING  NOISES  -  -  FILTER  DESIGN  ABORT") 

1848#*  RETURN 

1849#*  1  IFINMD.6T.4)  60  TO  2 

1834#*  MITE  IKTERM,  149) 

18314*  149  FORMAT ("4N0  HEASUREHENTS  -  -  FILTER  DESI6N  ABORT") 

18524*  RETURN 

18334*  2  MITE(KLIST,U4) 

18544*  114  F0RHAT(////1 11,31"*  *), "FILTER  DESIGN",5C  *">////) 
18554*  NSlZE*NHJ>td+MLD+NMD) 

18544*  IF(NSIZE.LE.NVFLT)  60  TO  3 

18374*  MITE  141,NS1ZE 

18584*  141  FORMAT {"4INSUFFICIENT  HEMORT  /CKF/,  NEED:  ",I4) 

18394*  LABORT*NSIZE 

18444*  RETURN 

18414*  3  NDIN*NPLD 

18424*  NDIH1«NDIH*1 

18434*  5  IF(NND.EB.I)  60  TO  12 

18444*  IF1IFLTR.LE.4)  60  TO  4 

18454*  MITE  145, NMD 

18444*  145  FORMAT (*  ENTER  STATE  NOISE  STRENGTHS:  ",I21 

18474*  CALL  RBHGTS(DN!L0),NND,4> 

18484*  4  .  CALL  DVCTOR!NND,OH!LB),ZH1) 

18494*  CALL  HATLST ( ZH1 , NMD, 1 , *  0" , KTERM) 

18744*  14  CALL  HATLST(DH(LB),NHD,NND,*B",KLIST) 

18714*  12  IF(NW».E0.4)  60  TO  IS 

18724*  IF(IFLTR.LEJ)  60  TO  13 

18734*  MITE  14A,NNDD 

18744*  144  FORMAT!"  ENTER  DISTURBANCE  NOISE  STRENGTHS:  ’,12) 
18754*  CALL  R0N6TS(8M(L0N),NM4D,4) 

18744*  13  CALL  DVCTOR!NNDD) DM(LON) , ZH1) 

18774*  CALL  HATLST!ZHl,NNDD,i, "AN* , KTERM) 

18784*  15  CALL  HATLST<DH<LW),NNDD,NWD,'W",KLIST) 

18794*  18  CALL  ODSCRT (DH(LB) , DM(LBN) , ZH1 , ZM2) 

18844*  IF(IFLTR.LE.4)  60  TO  19 

18814*  MITE  147, NMD 

18824*  147  FORMAT!"  ENTER  MEASUREMENT  NOISE  STRENGTHS:  ",I2) 
18834*  CALL  RflN6TS(DN(LR),NHD,4) 

18844*  19  CALL  DVCT0R(NHD,DH(LR),ZH1) 

18854*  CALL  HATLSTIZH1, NMD, 1,*R", KTERN) 

18844*  24  CALL  HATLST <DM(LR) ,NHD,NHD, *R',KLIST) 

18874*  23  CALL  TFRHTKDH(LHP),SH,NHD,NDIH,2) 

18884*  CALL  TRANS2<NHD,NDIH,SN,ZH1) 

18894*  LFCOV*LFLTRK+NOIH*NND 

18944*  CALL  DVCTOR(NHD,DM!LR),FLT(LFCOV)) 

18914*  CALL  KFLTR (NDIN, NMD, FLT, ZN1 , DN (LBD) , FLT ( LFCOV) , ZH2, 
18924*  1  FLT!LFLTRK),SM) 

18934*  CALL  TFRNTZ(SM,C0N2,NDIM,NDIM,2) 

18944*  IA*1 

18954*  DO  34  I*1,NPLD 

18944*  FLT(LFC0V-ld)*SBRT!ZN2(IA)) 

18974*  34  IA*IA+NDIN1 


18981s  CALL  MUST (FLT (LFLTRK)  ,MIH,NHD,  'KF*,KLIST) 

18991*  CALL  MUST  (FLT  (LFLTRK)  ,NDIH, NHD,  *KF',KTERH) 

19Mf*  IFLTR*1 

19818*  LFLKF*1 

19821*  111  F0RMTIA3) 

19838*  RETURN 

19848*C  END  SUBROUTINE  FLTRK 

19838*  END 

19868*  SUBROUTINE  FEVAL 

19878*  C0HH0N/MIN1/N0IN,  NDIN1 ,  CONI  ( 1 ) 

19888*  COHHON/MIN2/COfl2(I) 

19898*  COHIION/  INQU/KIN,KOUT ,  KPUNCH 

19188*  COHHON/DESI6N/NVCOH,  TSAHP, LFLRPI ,  LFLCST,  LFLKF ,  LTEVAL ,  L  ABORT 

19118*  COHMN/FIL£S/KSAVE,KDATA,KPLQT,KLIST,KTERH 

19128*  COMON/SYSNTl/NVSR,SN(l) 

19138*  COHHON/ZHTXl/NVZH,ZHl(l) 

19148*  C0NH0N/ZHTX2/ZH2<1) 

19158*  CONMN/NDIHD/NND,  NRD,  NPD,  NHD, NDD,  NHD,  NNDD,  NPLD,  NNPNND,  NNPR 

19168*  COHHON/LOCD/LAP, L6P, LPHI , LBD, LEI , LPHD, LB, LAN, LBD, LC, LOY, LEY, LHP,  LR 

19178*  COHHON/DSHHTX/NVDH,NODY,NOEY,DH(l) 

19188*  COHHON/NDlHT/NNT,NRT,NHT,NNT 

19198*  C0HMN/L0CT/LPHT,LBDT,L8DT,LHT,LRT,LTDT,LTNT 

19288*  CORHON/TR1JHT1/NVTM,  TH  ( 1 ) 

19218*  COHMN/LKF/LEADSN,  LFLTRK,  LFCOV 

19228*  COmtON/CXF/NVFLT,FLT(l) 

19238*  DIHENSION  ITITLECS) ,NS(3) ,NVPL0T(2) 

19248-  IF(NNT.6TJ)  60  TO  1 

19238-  UNITE (KTERN, 188) 

19268*  188  F0RMTC8NO  TRUTH  NODEL  DRIVING  NOISE  -  -  FILTER  EVALUATION  ABORTE 
19278*  ID*) 

19288*  RETURN 

19298*  1  NRITE4KLIST, 118) 

19388*  US  F0RMT(////111,3C*  ■), 'FILTER  EVALUATION', 51  ’  •')////) 

19318*  CALL  FMHUL4C08t2, FLT  (LEADSN) ,  NPLD,  NPLD,  NPLD,  SN> 

19328-  CALL  POLES  <S»t, NPLD,  3,  ZR1 ,  ZN2) 

19338*  NA*NNT*NPLD 

19348-  NS1ZE*NA*M 

19338*  IF(NSIZE.Ii.NVSN)  60  TO  8 

19368*  UNITE  1S1.NSIZE 

19378-  181  F0RMTC8INSUFFIC1ENT  NEHORY  /SYSHTX/,  NEED:  ',14) 

19388*  60  TO  9 

19398*  8  IF (NSIZE.LE.NVZN)  60  TO  18 
19488*  UNITE  183.NSIZE 

19418*  183  FORMTfSINSUFFICIENT  NEHORY  /ZHTXl/,/ZNTX2/,  NEED:  ',14) 

19428*  9  LABORT*NSIZE 

19438*  RETURN 

19448-  18  CALL  ZPART(SH,1,NSIZE,1) 

19458*  NDIH*NPLO 

19468-  NDIH1«NDIH*1 

19478*  CALL  TFRHTX (TH(LRT) , ZH1 , NHD, NHD, 2) 

19488*  CALL  MT3  (NPLD,  NHD,  FLT  (LFLTRK) ,  ZH1  ,COHi ) 

19498*  NV0UT«2»NPLD+1 

19588*  REUIND  KPLOT 

19318*  CALL  DACOV (SH, FLT (LFCOV) , ZH1 , ZH2, M, NVOUT, 8. ) 
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19321*  DO  2«  IT* 1,31 

19331*  TIHC-TSAHP*FLOAT(IT) 

19341*  CALI  ACOVUDtSN, TH(LflDT) ,COHl,TH(LPHT) ,FLT (LEADSN) , 

19331*  1  C0H2,  Zltl,  ZH2) 

19561*  CALL  DACOV(SH,FLT(LFCOV) ,ZR1,2H2,NA,NVQUT,TINEI 

19571*  21  CONTINUE 
19381*  ENDFILE  KPLOT 

19598*  WRITE (KTERH, 1#4> 

19688*  READ (KIN, 182)  ITITLE 

19618-  DO  38  I*1,NFLD 

19628*  REMIND  KPLOT 

19638*  NS(1)*1 

19648*  NS(2)*32 

19638*  NS(3)*I83 

19668*  NVPLOT(l)*I+I-l 

19678*  NVPL0T(2)*I*I 

19688*  DO  48  J*l,31 

19698*  CALL  RPLOTF(ZHl,NVOUT,IERR) 

19788*  IF(IERR.EB.l)  60  TO  58 

19718*  CALL  STRPLT(SN,ZH1,NS,NVPL0T,2,NV0UT) 

19728*  DO  33  K*l,3 

19738*  35  NS(K)=NS(K)+1 

19748*  48  CONTINUE 

19738*  WRITE  187,2Hl(NVPL0T(t>M,ZHl(NVPL0T(2>) 

19768*  187  F0RHATC8FINAL  RNS  ERRORS  :  TRUE  *  -.1PE15.7/-  (STATE',  13, 

19778*  1  ') ',41, 'CONFUTED  *  ',1PE15.7) 

19788*  CALL  PL0TLP(51,2,SH,-1, 1, 8, KLIST, ITITLE) 

19798*  WRITE (KLIST, 186)  I 

19888*  186  F0RHATC8  STATE  !  * , I2//4X, 'SVRBOL  1  :  TRUE  ERROR'/ 

19818*  1  41,'SYHBOL  2  :  CONFUTED  ERROR  '/) 

19828*  38  CONTINUE 

19838*  RETURN 

19848*  184  FORNATC  ♦•,18('-'),'  ENTER  TITLE  IN  BIVEN  FIELD  \18('-'),V/) 
19838*  182  FORNAT (5A18) 

19868*C  END  SUBROUTINE  FEVAL 

19878*  END 

19888*  SUBROUTINE  DAC0V(PCA,PC,ZN1,ZH2,NA,NV0UT,TINE) 

19898*  COHNON/HAINl/NDIH,NDIHl,COHl(i) 

19988*  CONNON/FILES/KSAVE,KDATA, KPLOT, KLIST, KTERN 

19918*  CONNON/WIHD/IMD,NRD,NPD,NND,NDD,NNO,NNDD,NPLD,NNPNHD,NNPR 

19928*  COHHON/NDIHT/NNT,NRT,NNT,NNT 

19938*  COHHON/LOCT /LPHT ,  LBDT ,  LOOT ,  LHT,  LRT ,  LTDT ,  LTNT 

19948*  COHHON/TRUHTX/NVTN, TH( l ) 

19938*  DIHENS20N  PCA(1),PC(1),ZN1(1),ZH2(1) 

19968*  NDIH*NA 

19978*  ND1H1-NDIN+1 

19988*  CALL  TFRNTX ( TH(LTDT) , ZN1 , NMD, NNT, 2) 

19998*  IF(NDD.LT.l)  60  TO  3 

28888*  IA*LADDR(NA,NND+I,i) 

28818*  CALL  TFRHTI (TN (LTNT) , ZH1 ( IA) , NOD, NNT, 2) 

28828*  3  CALL  NSCALE(ZH1,ZN1,NFLD,NNT,-1.) 

28838*  IA-LADDR(NA,1,NNM) 

28848*  CALL  IDNT(NPLD,ZH1(IA),1.) 

28858*  CALL  HAT3(NPLD,NA,ZN1,PCA,ZN2) 
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21460* 

NRITEUCLIST,  111)  TINE 

24470=  ill 

FORHATCI’TRUE’  DESIGN  ERROR  COVARIANCE  AT  TINE  *  *,F6.4) 

21481* 

CALL  NATI0(ZH2,NPLD,NPU>,3) 

20094* 

IA— 1 

20100= 

DO  11  I«1,NPU) 

24110= 

NS-I+I 

20120- 

ZN1 4NS-1  )*SMT  (ZN2(IA> ) 

20130= 

ZH1(NS)*PC(I) 

24144-  14 

IA-IA+NDIH1 

20150* 

2H1 (NVOUT)-TIHE 

20160- 

CALL  HPLOTF(ZN1,NVOUT) 

20170= 

RETURN 

20180-C  END 

SUBROUTINE  DACOV 

20190= 

END 

20200* 

SUBROUTINE  AC0VU04PC,QDyRKRKTtPHIT,PHIf RIHKH, ZH1,ZR2) 

20210- 

CONNON/NAIN1/NDIN, MINI, CONI  (11 

24224= 

COHNON/NDIHD/MiD,  NRD,  NPD,  (U1D,  HDD,  NHD ,  NNDD ,  HPLD ,  NNPNMD,  NNPR 

24234* 

CONMN/NDINT/NNT,  NRT,  WT,  MIT 

20244* 

COHNON/LOCT /LPHT , LBDT, LOOT , LRT , LRT , LTDT, LTNT 

24234* 

COHHON/TRUHTI/NVTH,TH(l> 

24244* 

COHNON/LKF /LEADS#, LFLTRK, LFCOV 

24274* 

COHHON/CKF/NVFLT.FLTd) 

20280* 

DIMENSION  PC(1),BD(1),RKRKT(1),PHIT(1),PHI(1),RINKH(1), 

20290* 

1  ZNK1),ZH2<1) 

24304* 

Ll-LADDR (NDIN, 1 , NNT+1 > 

24314= 

CALL  ZPMT(ZN2(Ll)tNNTyNPL0,NDIH) 

24324= 

CALL  TFRNTI (PHIT,ZN2,NNT,NNT,2) 

24334= 

L1«LA808(NDIH,NNT*1,NNM> 

24344* 

CALL  TFRNTI (PHI, ZH2(L1), NPLD, NPLD, 2) 

24334* 

L2«LADDR(N01N,NNm,l) 

24344* 

CALL  ZPART{ZN2(L2),NPL0,NNT,NDIH> 

24374- 

CALL  NAT3 (NDIN, NDIN, ZN2, PC, ZN1) 

24384* 

CALL  FPADDIZNlfNDIHfOD,NNTfNNTflvPC) 

24394- 

CALL  IDNT(NNT,ZN2,1.) 

24400* 

CALL  FHHUL1FLT (LFLTRK), TH(LHT), NPLD, NHD,NNT,ZH1) 

24414- 

CALL  TFRNTI ( ZH1 , ZH2 (L2) , NPLD,  MIT, 2) 

21424* 

CALL  TFRNTI (RINKH,ZN2 (LI), NPLD, NPLD, 2) 

20430- 

CALL  HAT3 (NDIN, NDIN, ZN2, PC, ZN1) 

20440* 

CALL  FPADDIZHl, NDIN, RKRKT, NPLD, NPLD, LI, PC) 

24434- 

RETURN 

21444-C  END  SUBROUTINE  ACOVUD 

20470- 

END 

24484- 

SUBROUTINE  FPADD(I,NI,Y,NRY,NCY,LADDR,Z) 

20490- 

DIMENSION  I(1),Z(1),Y (NRY,NCY) 

20300* 

CALL  FTNTI(I,Z,NI,NI) 

24314- 

LAN1-LADDR-1 

21324- 

DO  11  1*1,  NCY 

24334- 

LAI*LAH1+NI»(I-1) 

24344- 

DO  14  J*1,NRY 

20530- 

LA1-LA1M 

24344*  11 

Z(LA1)*Z(LA1)+Y(J,I) 

20370* 

RETURN 

24384-C  END 

SUBROUTINE  FPADD 

24394- 

END 
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2#6#«*  SUBROUTINE  RSYS(A,L,ND,ITYPE,INRT) 

21611*  C0HN0N/DESI6N/NVC0H, TSAHP, LFLRPI , LFLCBT, LFLKF, LTEVAL, LABOR! 

29621s  COttHOM/FILES/KSAVEf  KDATA, KPLOT, KLIST , KTERH 

21631*  COHHON/SYSMTX/NVSH,SH(l) 

21641*  COMHON/AMC/AHU) 

296S9*  CQHH0N/BD6/BD(1) 

2166#*  DIMENSION  A(1),L(1),ND(1),NAD(14,2),IND(7,3)-,NTYP(2,3),NTITLE<3>, 

29679*  1  NHAT (I4f3) 

29689-  DATA  NTYP/7,14,3,4,4,8/ 

21691*  DATA  NO/1HN/ 

29799*  DATA  UNI/1IM,  1HR,  1HP,  1HN, lHD, lHNt 2HN9v2NNHr2WH!f 2HPH,4 ( 1H  ), 

21711*  1  2HNT,2HRT,2HMT,2HNT,1H  ,1H  , 1H  / 

29729*  DATA  NTITLE/6HDESI6Nv7HC0HHANDf 3HTRUTH/ 

29739*  DATA  NHAT/IHA,  HOy2HEXf lH6f 1HQV 1HC,2HDY,2HEY,1HH,2HHN,1HR,2HA  N, 

21741*  i  2H6N,2H0N,2HAM,2HBM,2HCM,2HDM,1#(1H  ) , 2HAT, 2HBT, 2H6T, 2HBT, 2HHT, 

29759*  2  2HRT,3HTDT,3HTNT,6(1H  )/ 

29769*  NDM*NTYP(1, ITYPE) 

29779*  NAR*NTVP(2, ITYPE) 

2#78i*  NT*NTITLE(ITYPE) 

21791*  NRITE (KLIST, 11#)  NT 

2#8##=  11#  F0RMAT(////11X,5('*  ->,A7f •  MODEL', 5C  #*>////) 

2#81#*  5  WRITE  lfl,NT 

29829*  1#1  FORMAT ( *#R£AD  *,A7,*  MODEL  FROM  ’DATA'  FILE  (Y  OR  N)  >*) 

2#83#>  READ  1U,IANS 

29849*  IF(IANS.EO.NO)  60  TO  1# 

383#*  IF*1 

386#*  CALL  READFS(AtNO,  ITYPE, IERR) 

2#879*  IF  (IERR.  EQ.  f )  GO  TO  31 

388#*  1#  WRITE  1#2,NT 

2989#*  1#2  FORMAT (*  ENTER  a,A7,*  MODEL  FROM  TERMINAL  (Y  OR  N)  >’) 

2999#*  READ  111, IANS 

391#*  IF  (IANS. EB. NO)  60  TO  13 

29929*  IF*2 

2#93f*  DO  12  1*1, NDM 

2#94«*  NRITE  112,INDII,ITYPE) 

2#93#»  112  FORMAT (•  ENTER  ',A2,'  >') 

2996#*  12  REAO*,ND(I) 

397#*  60  TO  31 

2#98#»  13  IF*3 

399#*  IFCITYPE-2)  16,17,18 

21###*  16  CALL  DSND(ND) 

21(1#*  60  TO  2# 

21#29*  17  CALL  CMDD(W) 

21#39*  60  TO  3 

21#4#>  18  CALL  TRTHD(ND) 

21#3#»  3  IF (ND ( 1 ) . 6T. #)  60  TO  2#1 

2196#*  NRITE  114, NT 

21(7#*  114  FORMAT (,#*,A7I'  MODEL  SUBROUTINE  NON-EXISTENT') 

21(8#*  60  TO  3 

2199#*  31  IFUTYPE-2)  21,22,23 

2119#*  21  CALL  DSNDM(ND,NAD) 

2111#*  60  TO  3 

2113*  22  CALL  CHDDH(NO,NAD) 

2113#*  60  TO  3 


•_  *v 


2114#*  23  CALI  TRTHDH(ND,NAD) 

2113#*  23  IFaASORT.EB.f)  GO  TO  26 
21161*  WRITE  183,MT,LAB0RT 

21171*  113  FORMAT ! *1 INSUFFICIENT  MEMORY  FOR  *,A7,*  MODEL,  NEED:  *,I4> 

2118#*  RETURN 

2119#*  26  L(l)*l 

212##-  DO  38  1*2, MAR 

21211-  31  L(I)*L(I-1)+NAD<I-1,1)*NADI 1-1,2) 

2122#*  NPNTS-L (MAR) +NAD (NAR, 1 ) (MAD (MAR, 2) -1 
21231*  IF(NPNTS.LE.NVSM)  60  TO  34 
2124#*  WRITE  lf4,NPNTS 

2123#*  1#4  FORMAT Cl INSUFFICIENT  MEMORY  /SYSHTX/,  NEED:  *,I4) 

21261*  LABORT*MPMTS 

2127#-  RETURN 

21281*  34  1F1IF-2)  73,33,51 

21291-  33  IZ-1 
213##*  DO  4#  1*1, NAR 
21318*  N!*NAD(I,1) 

21328*  N2*NAD(I,2) 

21338*  lF((Nl.Efi.8).0R.(N2.Efl.8))  60  TO  48 

21348*  WRITE  U3,NHAT!I,ITYPE) 

21338*  113  FORMAT C8ENTER  *,A3) 

21368*  CALL  ZHATIN(A(L(I)),N1,N2, IZ) 

21378-  48  CONTINUE 
21388*  60  TO  73 

21398*  38  CALL  ZPART4A, 1 ,NPMTS, 1) 

21488*  IF!ITYPE-2>  33,68,65 

21418*  33  CALL  DSNmAiUl)),A(U2)),A(U3)),AtU4)),A(L(3)),A(L(6)),A<L(7)), 
21428*  1  A(L(B)),A(L(9)),A(L(18)),A(L(11)),A(L(12)),A(L(13) ),A(L(14)I) 

21438*  60  TO  73 

21448*  68  CALL  CNDN<A!L!1)>,A<L<2>>,A!H3)),A<L14)>) 

21438*  60  TO  73 

21468*  63  CALL  TRTWMA(LU)),A(L(2)),A(L(3)),A4L(4)),A(L(3)),A(L(6)), 

21478-  1  A(L(7)),A(L(8))) 

21488*  73  12*8 

21498*  77  WRITE  183 

21388*  183  FORMAT C8N0DIFY  MATRIX  ELEMENTS  (Y  OR  N)  >*) 

21518*  REAP  lll.IANS _ 

21328*  IF(IAHS.Efl.NO)  60  TO  88 _ 

21338*  WRITE  186,<NNAT(I,ITYPE),l*l,NAR> 

21548*  186  F0RHAT41X, 1442X, A3) ) 

21338*  78  WRITE  187 

21368*  187  FORMAT!*  ENTER  MATRIX  NAME  >*) 

21378*  READ  111, IANS 

21588*  DO  88  1*1, NAR 

21598*  IF<!ANS.EB.NNAT(I,ITYPE»  60  TO  81 

21688*  88  CONTINUE 

21618*  60  TO  78 

21628*  81  WRITE  116 

21638*  116  FORMAT!*  LIST  MATRIX  TO  TERMINAL  (Y  OR  N)  >*) 

21648*  READ  111, IANS 

21658*  IF(IANS.EB.NO)  SO  TO  83 

21668*  CALL  NATLST(A(L(I)),NA0(I,U,NAD(I,2),NHAT(I,ITYPE),KTERM) 

21678*  83  CALL  ZMATIN(A(L(I)),NAD(I,1>,NAD(I,2),IZ) 


2168#* 

60  TO  77 

21691*  88 

IF<ITYP£.E8.2)  CALL  FTHn<A(L(l)),AH,ND(l),ND(l)) 

217N* 

IF(ITYPE.EO.l)  CALL  FTNTX(A(LC2)),8D,ND(1),ND(2)) 

2171#*  9# 

IF ( IHRT)  93,92,93 

2172#*  92 

IHRT-1 

2173#*  9J 

WRITE  113, NT 

2174#*  US 

FORMAT f *#HRITE  *,A7,'  MODEL  TO  ’SAVE*  FILE  (Y  OR  N)  >') 

2173#* 

READ  111, IANS 

1  / - 

— dalcti  on - — /  I 

2176#* 

IF ( IANS.EQ. NO)  60  TO  93 

2177#* 

CALL  NFILED(ITYPE,NPNTS,ND,A) 

2178#* 

INRT-l 

2179#* 

WRITE  1#9,NT 

218##*  1#9 

FORMAT (6X,A7,a  HODEL  MITTEN  TO  ’SAVE’  FILE') 

2181#*  93 

DO  If#  1*1, NAR 

2182#* 

N1*NAD(I,1) 

2183#* 

N2*NAD(I,2) 

2184#* 

IF ( INI . EO. •) . OR. (N2.EB. •) )  60  TO  If# 

2183#* 

CALL  NATLST(A(L(in,Nl,N2,NNAT(I,ITYPE),KLIST) 

2186#*  1## 

CONTINUE 

2187#*  111 

FORMAT  (A3) 

2188#- 

RETURN 

2189#*C  END  SUBROUTINE  RSYS 

2190#* 

END 

2191#* 

SUBROUTINE  DSND(NO) 

2192#* 

DIMENSION  10(1) 

2193#- 

NO  < 1 )  *# 

2194#* 

RETURN 

2193#*C  END  SUBROUTINE  DSHD 

2196#* 

END 

2197#* 

SUBROUTINE  CNDD(NO) 

2198#* 

DIMENSION  ND(l) 

2199#* 

NO  ( 1 )  *# 

22###* 

RETURN 

22#1#*C  END 

SUBROUTINE  CNDD 

22#2#» 

END 

22#3«* 

SUBROUTINE  TRTND(ND) 

22#4#* 

DIMENSION  NDU) 

22#5#» 

ND(1)*# 

22#6#» 

RETURN 

22#7f*C  END  SUBROUTINE  TRTHD 

22#8f* 

END 

22#9#« 

SUBROUTINE  DSNN(A,B,EX,6,Q,C,DY,EY,H,HD,R,AD,6D,QD) 

221##* 

RETURN 

22U#*C  END  SUBROUTINE  DSNH 

2212#* 

END 

2213#* 

SUBROUTINE  CNDH(AH,BH,CN,DN) 

2214#* 

RETURN 

2213#*C  END  SUBROUTINE  CHDH 

2216#* 

END 

2217#* 

SUBROUTINE  TRTHN(AT,BT,6T,BT,HT,RT,TDT,TNT) 

2218#* 

RETURN 

2219#*C  END  SUBROUTINE  TRTHN 

222##* 

END 

D-51 


2221*- 

SUBROUTINE  DSNDM<ND,NAO> 

2222*- 

CMN0N/BESI6N/NVC0N,  TSMP,  LFLRP1 ,  IFLC6T,  LFUF,ITEVAL,  LABORT 

2223*- 

CONNOR/NOIND/NND,NRD,NPD,NHD,NDO,NND,NNDD,NPLD,NNPNND,NNPR 

2224*- 

COmON/BSNNTl/NVON,  NOOV ,  NOEY,  DN(  1) 

22258= 

DIMENSION  ND(1),NAD<14,2> 

2226*- 

NND-ND(l) 

22278= 

NRD*N0(2) 

22288= 

NPD-NDC3) 

22298= 

NHD*ND(4) 

223**- 

N0D=ND(3) 

2231*- 

MUH8H61 

22321= 

NNDD*NDI7) 

22331= 

NPUHMWDI 

22341= 

NHPtND=NM+NMD 

22331* 

NNPR*NND+NRD 

2236*- 

NAD(1,1)*N» 

2237*= 

NAD  <2,11-1810 

2238*= 

NAD(3,1)*NM 

22398= 

NAD(4,1)*NND 

22488= 

NA0(3,1)=NN0 

22418= 

NAD(6,1)=NPD 

22428= 

NAD(7,1)«NPD 

22438= 

NAD(8,1)=NPD 

22448* 

NAD<9,11*NW> 

22438= 

NAD(18,1)*NNB 

22468* 

NA0<U,1)*NND 

22478= 

NAD(12,1)=N00 

22488= 

NAD(13,1)=NDD 

22498= 

NAI(14,1)«NNDD 

22388= 

NAD(1,2)*NN» 

22318= 

NAD(2,2)=NRD 

22328* 

NA0(3,2)«ND0 

22538= 

NAD(4,2)=NND 

22348= 

NAD(5,2)*NND 

22538= 

NAD(6,2)-NND 

22368* 

NAD(7,2)=NR0 

22578= 

NA0(8,2)*NDD 

22388= 

NA0<9,2)=NN0 

22598= 

NAD<18,2)*NDD 

22688* 

NA0(U,2)*NHD 

22618* 

NA0(12,2)*ND0 

22628* 

NAD  1 13,21**100 

22638* 

NAD(14,2)*NNDD 

22648= 

NSIZE=NPU)»(2HIPLD+NND*NND+NPD*NNPNND)  +NRD*  (NND+NPD)  ♦ 

22638* 

1  NDD*NDD+NND*NNO+NNO*NND+NNDD*NNDD 

22668* 

IF(NSIZE.GT.NVDH)  LABORT«NSIZE 

22678* 

RETURN 

2268f*C  END  SUBROUTINE  OSNDN 

22698= 

END 

22788= 

SUBROUTINE  CHDDH4N0, NAD) 

22718* 

COHNON/NDIHC/NNC,NRC,NFC 

22728= 

CONNOR/ CHDHTI  /NVCH, NEKCH,  NODC , CM ( 1 1 

22738= 

COHNON/DESIGN/NVCON, TSANP , IFLRP I , LFLCBT , LFLKF , LTE VAL , LABORT 

22748* 

DIMENSION  ND(1),NAD<14,21 
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22731*  NNC*N0(1) 

22761*  NRC*ND(2) 

22771*  NPC*ND(3) 

22781*  NADd,l)*NNC 

22791*  NA0(2,1)*NNC 

2281#*  NAD13,1)*NPC 

22811*  WUH4,1>«MPC 

2282#*  NADd,2>*NNC 

2283#*  NAD<2,2)*NRC 

2284#*  NA0(3,2)*NNC 

2283#*  NAD(4,2)*NRC 

2286#*  NS1ZE*NNC«(NNCAIRC*NPC)+NPC»NRC 

2287#*  IF(NSIZ£.6T.MVCH}  IABQRT-NSIZE 

2288#*  RETURN 

2289#*C  END  SUBROUTINE  CNDDN 

229##*  END 

22918*  SUBROUTINE  TRTHDH(ND,NAD> 

2292#*  C0HMN/DESI6N/NVC0N,  TSAHP,LFLRPI ,  LFLCGT ,  LFLKF, LTEVAL,  LABORT 

2293#*  COHMN/NDMD/NND,  NRD,  NPD,  NND,  NDD,  NND,  NNDD,  NPLD,  NNPNND,  NNPR 

2294#*  COffllON/NOINT/NNT,NRT,NHT,NHT 

2295#*  COHMN/TRUHT1  /NVTN,  TN  d ) 

2296#*  DIHENSION  NDd),NADd4,2) 

2297#*  NNT*ND(1) 

2298#=  NRT*ND(2) 

2299#*  NNT*ND(3) 

23###*  NNT*N0<4) 

23818*  NAD  ( 1 , 1 )  *8WT 

23828*  NADt2,l)*NNT 

23838*  NAD(3,1)*NNT 

23848*  NAD(4,1}*MT 

23838*  NAD(5,1)*NHT 

23868*  NAD(6,1)*NNT 

23878*  NAD(7,1)*NND 

23888*  NAD(8,1)*NDD 

23898*  NADd,2)«NNT 

23188*  NAD(2,2)-NRT 

23118*  NA0(3,2»*NNT 

23128*  NAD(4,2)*NNT 

23138*  NA0(5,2)*NNT 

23148*  NAD(6f2)*NNT 

23158*  NAD(7,2)*NNT 

23168*  NA0(8,2)*NNT 

23178*  NSIZE*NNT*<2AMTAMDAttDmD>+NfD»NHD 

23188*  IF(NSIZE.6T.NVTH)  LABQRT*NSIZE 

23198*  RETURN 

232#f*C  END  SUBROUTINE  TRTHDN 

23218*  END 

23228*  SUBROUTINE  ZHATIN(A,NR,NC,IZ) 

23238*  DIHENSION  A(NR,NC) 

23248*  IFdZJ  18,18,1 

23238*  1  DO  5  1*1, NR 

23268*  DO  5  3*1, NC 

23278*  3  All, 3)*#. 

23288-  If  MUTE  lfl,NR,NC 


Irw 


23291*  13  R£AD*,1'*»V 

233M*  IF(I.EB.f)  RETURN 

23311*  IF((I.LE.NR).AND. (J.LE.NC))  60  TO  21 

23321*  MUTE  112 

23331*  60  TO  1! 

23341*  2#  A(I,J)*V 

2333f*  IF (IZ.LT.i)  A(J,I)*V 

2334#*  60  TO  13 

2337#*  1#1  FORMAT ('  ENTER  1,J  AND  <•/  HHEN  COMPLETE)  :  *12,*  BY  *12 

2338#*  1  *  >') 

2339#*  1#2  FORMAT!*  ERROR  IN  ARRAY  INDEX*) 

234#f*C  END  SUBROUTINE  ZNATIN 

2341#*  END 

2342#*  SUBROUTINE  NFILED(NT,NP,ND,A) 

COMHON/F ILES/KSAVE.  KDAT  A.  KPLOT ,  (CL  1ST ,  KTERH 


12344#* 

DIMENSION  ND<15).A(tf) 

2343#* 

DATA  IE0I/-1/ 

2344#* 

BACKSPACE  KSAVE 

2347#* 

WRITE (KSAVE.lfl)  NT.NP 

i  2348#* 

WRITE (KSAVE, If  1)  (ND(I),W,13)  _ 

2349#- 

WRITE (KSAVE, 1#2)  (A(I),I*1,NP) 

233##* 

WRITE (KSAVE, 1#1)  1E0I,NP 

2331#* 

RETURN 

2332#*  1#1  FORMAT (214) 

2333#-  If 2  FORMAT (E2B. If) 

2334f*C  END  SUBROUTINE  HFILED 

2335#- 

END 

2334#* 

SUBROUTINE  READFS(A,M,NT,IERR) 

COMMON/FILES/KSAVE, KDATA, KPLOT, KLIST, KTERH 

23 %£  _  DIMENSION  A(1),ND(15> _ 

2339#*  DATA  IE0I/-1/  “ 

234##*  REMIND  KDATA 
2341#*  3  READ (KDATA, 1#2)  IT, HP 
2342#*  IF(IT.NE.IEOI)  60  TO  I# 

2363#=  WRITE  Ifl 

2364#*  IERR*1 

2363#*  RETURN 

2344#*  1#  CALL  FARRAY(A,ND,NP) 

2367#*  IF(IT.NE.NT)  60  TO  3 
2348#*  IERR*# 

2349#*  1#1  FORMAT CfDATA  NOT  IN  'DATA'  FILE 
237##*  1 #2  FORMAT (214) 


2372#*C  END 
2373#* 
2374#* 
2375#f_  _ 
2376#* 


2379#* 
238##*  1#1 
2381#*  112 
2382#*C  END 


SUBROUTINE  READFS 
END 

SUBROUTINE  FARRAY(A,ND,NP) 
COmON/FILES^KSAVEJCSATA,  KPLOTJ^ISTiKTEMJ 
'DIMENSION  A(NP),ND(15) 

READ (KDATA. If 1)  <NO(I), 1*1.13) 


READ (KDATA, If 2)  (A(I),I*1,NP) 

RETURN 

FORMAT (214) 

FORMAT (E2#.l#) 

SUBROUTINE  FARRAY 


.V. 

\N.' 


<15 


-f.  v 
*  / 


23831*  END 

23841*  SUBROUTINE  TFRHTmi,I2,NR,NC,m) 

238Sf*  COimON/IMINl/NDIH 

23861*  DIMENSION  11(1), 1(2(1) 

23871*  IFdTX.EQ.2)  60  TO  2f 

23881*  J*NC*NDIH 

23891*  KK*f 

23988*  DO  If  I*1,J,NDIH 

23911*  L*I+NR-1 

23928*  DO  If  JJ*I,L 

2393f*  KK*NK+1 

23948*  If  I1(KJC)*X2(JJ) 

23958*  RETURN 

23968*  28  KK*NR*NC+1 

23978*  DO  38  1*1, NC 

23988*  L*  (NC-I )  •ffflIH+1 

23998*  DO  38  J*l,Mt 

24888*  KX*KK-1 

24818*  JJ*L+NR-J 

24828*  38  X2(JJ)*X1 (KK) 

24838*  RETURN 

24848*  END 

24858*  SUBROUTINE  HATLST (A, NR, NC,NT , KDEV) 

24868*  DIMENSION  A(NR,NC) 

24878*  MUTE  (KDEV,  181)  NT 

24888*  DO  18  1*1, NR 

24898*  18  HRITE (KDEV, 182)  (A(I,J>,J*1,NC) 

24188*  181  FflRHAT(IH8,AJ, '  NATR11V) 

24118*  182  FORMAT ( 1X1P18613.4) 

24128*  RETURN 
24138*C  END  SUBROUTINE  HATLST 
24148*  END 

24158*  SUBROUTINE  NDSCRT(A,N,NTERMS) 

24168*  COMHON/DES 1 8N/NVC0M , TSANP , LFLRP I , LFICST , LFLKF , LTEVAL ,  (.ABORT 

24178*  DIMENSION  Ad) 

24188*  XTERNS*IFIX(6.+3.»TSANP»XN0RH(N,A)) 

24198*  IF(NTERNS.6T.38)  NTERMS*38 
24288*  RETURN 

24218*0  BID  SUBROUTINE  NDSCRT 
24228*  END 

24238*  SUBROUTINE  ROUSTS <N,ND,NP) 

24248*  DIMENSION  N(l) 

24258*  18  MUTE  181 

24268*  181  FORMAT!'  ENTER  I  AND  BN<I,I)~(f/  NHEN  COMPLETE)  >') 

24278*  IS  READ*,I,V 

24288*  IF(I.EB.f)  RETURN 

24298*  IF(I.LE.ND)  60  TO  28 

24388*  MUTE  182 

24318*  182  FORMAT!'  ERROR  IN  ARRAY  INDEX') 

24328*  60  TO  18 

24338*  28  IF(V)  25,38,48 

24348*  25  MUTE  183 

24358*  183  FORMAT ('  ELEMENTS  MUST  BE  N0N-NE6ATIVE') 

24368*  80  TO  IS 


24371*  3#  IF (HP)  35,41,33 
24381*  35  MUTE  114 

24391*  104  FORNATC  ELENENTS  MUST  BE  POSITIVE1) 

244H*  60  TO  13 

24411*  41  L1*LADDR(ND,I,I) 

2442 I*  0(L1)*V 
24431*  60  TO  13 

2444#*C  END  SUBROUTINE  RQN6TS 
24451*  END 

24460*  SUBROUTINE  DVCTOR(N,A,V> 

24471*  DIHENSION  A<1),V(1> 

24481*  NP1*NM 

24491*  N2*N#N 

245M*  J*D 

24511*  DO  1«  I*1,N2,NP1 

24520*  J*J+1 

24530*  If  V(J)*A(1) 

24340*  RETURN 

2455D-C  END  SUBROUTINE  DVCTOR 
24560*  END 

24571*  SUBROUTINE  P0LES(A,N,ITYPE,ZN1,ZN2) 

24580*  COHHON/HAIN1/NDIH,ND!H1,COH1(1) 

24590*  COHMN/DESI 6N/NVC0N,  TSANP ,  LFLRPI ,  LFLC6T,  LFLKF,  LTEVAL,  L  ABORT 

246H*  CONHON/FILES/XSAVE, KDATA,  KPLOT ,  KLIST, KTERN 
24610*  DIMENSION  NTYPI5) , A(l> ,ZH1 (1) ,ZH2(1) 

24621*  MTA  NTYP/6H0ESI6N,  7MC0MAND,  S4TRUTH,  5HRE6PI ,  6HFILTER/ 
24631-  NDS-NDIH 

24641*  NDIH*N 

24651*  NDIM*NDIH+l 

24660*  CALL  EI6EN1N0IH,  A,  ZH1 ,  ZN1  (NDIN1) ,  ZH2,  f ) 

24670*  IF4ITYPE.LT.4I  60  TO  II 

24681*  CALL  NAP0LE(N,ZN1,ZH1(NDIN1), TSANP) 

24691*  II  HRITE(KLIST,!I2)  NTYP(ITYPE) 

247M*  MITE  (KTERN,  112)  HTTP  (I  TYPE) 

24711*  MITE  (KLIST,  111)  <ZN1(I),ZNI(NDIIHI>,I*1,N) 

24721*  MITE  (KTERN,  111)  (ZN1(I),ZH1(NDINM),I*1,N) 

24731*  NDIH*NDS 

24741*  NDIH!*NDIN+1 

24750*  111  F0RNAT(«,1PE15.7,'  ♦JC,  1PE15.7, •) •) 

24761*  112  FORNATCIPOLES  OF  a,A7,'  MATRIX"/) 

24771*  RETURN 

2478I*C  END  SUBROUTINE  POLES 

24791*  END 

248M*  SUBROUTINE  HAPOLE(N,ZR,ZI,T) 

24811*  DINENSION  ZR(1),ZI(!) 

24821*  RT-l./T 

24831*  DO  II  1*1, N 

24841*  ZN*S0RT(ZR(I)»2+ZI<I)**2) 

24854*  SI6HA*RT«AL06IZH) 

24861*  ZI(I)*RT«ATAN2(ZI(I),ZR(I)) 

24871*  II  ZR(I)*SI6NA 

24881*  RETURN 

2489I*C  END  SUBROUTINE  HAPOLE 
249M*  END 


V  *  4  •  P 


■  v 

24911* 

FUNCTION  LADDR(NR,I,J) 

r-V 

24921* 

LADDR*I+NR*<J-1) 

24931* 

RETURN 

Hi 

2494#*C  END  FUNCTION  LABOR 

24951* 

END 

24961* 

SUBROUTINE  FTHTXU,Y,NR,NC) 

Es 

24971* 

DIMENSION  1(1), Yd) 

fcv 

24981* 

NE*NR«NC 

PS 

2499#* 

DO  1#  1*1, NE 

Ka| 

23Mf*  If 

V(I)*X(I) 

2Sflf* 

RETURN 

K\ 

25I2#*C  END  SUBROUTINE  FTNTX 

t'-' 

2513#* 

END 

Kl 

2S#4#> 

SUBROUTINE  FHNUL(X,Y,NR1,NC1,NC2,Z) 

2515#* 

DIMENSION  X<NR1,NC1),Y{NC1,NC2),Z(NR1,NC2> 

Hi 

25#6#* 

DOUBLE  PRECISION  TD 

Hvi 

2517#= 

DO  1#  1*1, NR1 

jw 

2S#8«* 

DO  1#  J*1,NC2 

PS 

25#9#» 

TD*#.D## 

Ry 

251##* 

DO  5  K*1,NC1 

2511#*  5 

TD*TD*X(1,K)»Y(K,J) 

Kh 

2512#*  1# 

Z(I,J)*TD 

2513#* 

RETURN 

I'i 

2514#*C  END  SUBMUTINE  FNNUL 

2515#* 

END 

2516#* 

SUBROUTINE  FTHUL(X,Y,NR1,NC1,NC2,Z) 

1  w 

2517#* 

DIMENSION  X<NR1,NC1),Y(NR1,NC2),Z(NC1,NC2) 

2518#* 

DOUBLE  PRECISION  TO 

2519#* 

DO  If  1*1, NCI 

252##* 

DO  1#  J*1,NC2 

2521#* 

TD*#.D## 

1;' 

2522#* 

DO  5  K*1,M1 

2523#*  5 

TD*TD+X(K,I)»Y(K,J) 

IH 

2524#*  If 

Z(I,J!*TD 

2525#* 

RETURN 

l, 

2326f*C  END  SUBMUTINE  FTNUL 

I  ’ 

2527#* 

END 

2528#* 

SUBROUTINE  FNADD(X,Y,NR,NC,Z) 

L. 

2529#* 

DIMENSION  XU),Y(1),Z(1> 

RPl 

253##* 

NE*NR*NC 

C? 

2531#* 

00  1#  1*1, NE 

2532#*  1# 

ZU)*XII)*V(I) 

|y 

2533#* 

RETURN 

|£v 

2534#*C  END  SUBMUTINE  FNADD 

■  V 

2535#* 

END 

§■ 

2536#* 

SUBROUTINE  ZPART(A,NR,NC,ND> 

\ 

2537#* 

DIMENSION  All) 

& 

2538#* 

NE*NC*ND 

jf 

2539#* 

DO  1#  1*1, NR 

X' 

254##* 

DO  1#  J*I,NE,MB 

2541#*  If 

A(J)*#. 

i  ^ 

2542#* 

RETURN 

2S43f*C  END  SUBMUTINE  ZPART 

o 

2544#* 

END 

fc 
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2545#*  SUBROUTINE  SUBI (A, NR, HD) 

25461*  DIMENSION  A(l) 

25471*  NDt*NDM 

2548#*  NE=NR»ND 

2549#*  DO  1#  1= 1 , NE, ND1 

255##*  1#  A(I)*A(I)-1. 

2551#*  RETURN 

2552#*C  END  SUBROUTINE  SUBI 
25531-  END 

2554#*  SUBROUTINE  NPLOTF(V,N) 

2555#*  CONNON/F1LES/KSAVE, KDATA, KPLOT,KLIST,KTERN 

2556#*  DIMENSION  V(N) 

2557#*  WRITE (KPLQT, 111)  (V(I),I*1,N) 

25581*  RETURN 

2559#*  191  FORMAT (E29. 19) 

256##*C  END  SUBROUTINE  HPLOTF 
2561#*  END 

2562#*  SUBROUTINE  RPL0TF(V,N,1ERR> 

2563#*  COMMON/FILES/KSAVE, KDATA, KPLOT,KLIST,KTERM 

2564#-  DIMENSION  V(N) 

2565#*  READ4KPLQT , 191)  <V(I),I*1,N) 

2566#-  IF (EOF (KPLOT) )  5,11 

25671*  5  IERR*1 

2568#*  RETURN 

25691=  1#  I ERR*# 

257##*  RETURN 

25718*  1#1  F0RHAT(E2#.U) 

2572#*C  END  SUBROUTINE  KPLOTF 
2573#*  END 

2574#-  SUBROUTINE  STRPLT(A,V,NS,NV,NP,NVO) 

2575#*  DIMENSION  A(l),NS(l),NVd),V(l) 

2576#*  AlNSd))=V(NVQ> 

2577#*  DO  5  I*S,NP 

2578#*  5  A(NS(I+l))*V(NVd)) 

25791*  RETURN 

258##*C  END  SUBROUTINE  STRPLT 

2581#-  END 

2582#*  SUBROUTINE  PLQTLP(N,H,A,IPSC,ISCL,LPTERH,NDEV,ITITLE) 

2583#*C  ********** 

2584#*C  *  N  *  NUMBER  OF  POINTS  TO  BE  PLOTTED 

25B5#*C  *  M  *  NUMBER  OF  OUTPUTS  TO  BE  PLOTTED 

2S86#*C  #  A  *  VECTOR  OF  SAMPLE  POINTS  FOR  PL0TTIN6  :  DIMENSION  *  N§N 

2SB7#*C  *  ELEMENTS  1  TO  N  ARE  THE  INDEPENDENT  VARIABLE 

2S88#*C  *  ELEMENTS  (N+l)  TO  2*N,  I2»N+1)  TO  3*N,  AND  SO  ON  ARE 

2S89#*C  »  THE  DEPENDENT  VAR  I  ABIDES — EACH  VARIABLE  IS  IN  CONSECUTIVE 

259##*C  t  ST0RA6E  WITH  CORRESPONDING  SAMPLE  POINTS  FOR  EACH 

2591#*C  *  SEPARATED  BY  MULTIPLES  OF  N 

2592#*C  *  IPSC  *  -1  *>  SCALE  ALL  VARIABLES  TOGETHER  <1  PLOT) 

2593#*C  *  *  #  *>  SCALE  T06ETHER  AND  SEPARATELY  (2  PLOTS) 

2594#*C  t  *  +1  *>  SCALE  SEPARATELY  <1  PLOT) 

2395f*C  t  ISCL  *  #  *>  PLOT  OVER  EXACT  RANGE  OF  VARIABLE 

2596f*C  »  *  1  *>  PLOT  USING  EVEN  SCALING 

2397I*C  ♦  LPTERM  *  #  *>  PLOT  IS  TO  TERMINAL  (5#  CHARACTERS  HIDE) 

2598f*C  *  *  1  *>  PLOT  IS  TO  LINE  PRINTER  (1##  CHARACTERS  HIDE) 
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2599§*C  *  NDEV  *  DEVICE  NUMBER  FOR  PLOT  OUTPUT 

26000*C  *  ITITLE  -  VECTOR  (DIMENSIONED  3)  WITH  5f  CHARACTER  TITLE 

26010=C  MHHMH 

26020=  DIMENSION  YSCAU6),YMIN<6),IBLNK<6),YPRdl>,Ad) 

26030=  INTE6ER  OUT ( 101 ) , SYMB0LI6) , BLANK, PLUS, BRIO, ITITLE (5) 

26040=  DATA  BLANK , PLUS f COLON, SYMBOL / 1 H  ,1H+,1H:,1H1,1H2,1H3,1H4,1H5,1H6/ 
26030=  1  FORMATdH  ) 

26060=  2  FORMAT (1H1,11X,5A10/) 

26070=  10  F0RHATI1H  ,F11.2,6X,101Al) 

26000=  12  FORMAT dlH0  SCALE  ,A1,  lXf  11F10.4) 

26090=  IPAPER=5*d*LPTERH) 

26100=  ISPAC=10*IPAPER 

26110=  RISPAC=FLOAT(ISPAC) 

26120=  ISPAC=ISPAC+1 

26130=  IPRT1=IPAPER+1 

26140=  RHIN*A(N*1) 

26150=  RHAX*RHIN 

26160=  23  DO  41  ISC*l,lt 

26170=  H1*ISC»N+1 

26180=  YL=A(M1> 

26190=  YH*YL 

26200*  H2=N*(ISC*1) 

26210=  DO  40  J*H1,H2 

26220*  IF(AU).LT.YL)  80  TO  30 

26230*  IF(A(J).8T.YH)  YH*A(J) 

26240=  60  TO  40 

26230=  30  YL*A(J) 

26260*  40  CONTINUE 

26270*  IF(YL.LT.RHIN)RNIN«YL 

26280*  IF(YH.GT.RHAX)  RHAX=YH 

26290*  IF(IPSC.6E.0)  CALL  VARSCLTYL, YH, YSCALiISC) f RISPAC, ISCL) 

26301*  41  YNIN(ISC)=YL 

26310=  IF(IPSC.LE.0)CALL  VARSCL 4RHIN, RHAX, SCAL, RISPAC, ISCL) 

26320=  IC=2-IABSdPSC) 

26330=  DO  45  IX=>1,ISPAC 

26340*  43  OUTdX)=BLANK 

26350=  DO  100  IC0*1,IC 

26360=  HRITE1NDEV, 2)  (ITITLE ( I) , 1=1 ,S) 

26370*  DO  60  1=1, N 

26380*  XPR*A ( I > 

26390*  IF(HODd,10).EB.0)  60  TO  458 

26400*  68ID*BLANK 


26420*  458  6RID=COLON 
26430=  460  DO  461  IX*2,ISPAC,2 
26440*  461  OUT(IX)*SRID 
26450*  DO  46  IX*1,ISPAC,10 
26460*  46  OUTdX)*PLUS 


26480* 

IL*I+J«N 

26490* 

IF  (IPSO  48,47,49 

26500*  47 

IPSCT*IPSWCO 

26510* 

IF(IPSCT.EB.2)  60  TO  49 

26520*  48 

JP*2FlX((AdL)-RMN)/SCAL)+l 

26531= 

80  TO  58 

26540=  49 

JP*IFIX((A(1L)-YHIN<J))/YSCAL(J!)+1 

26551=  5f 

OUT(JP)=SYHBOL(J) 

26561=  55 

IBLNK(J)*JP 

26570= 

WRITE (NOEV,  18)  XPR,  lOUT(IX) ,  17*1, ISPAC) 

26581= 

DO  59  J*1,H 

26590* 

ITEHP*IBLNK(J) 

26600=  59 

QUT(ITEHP)*BLANK 

26611=  6f 

CONTINUE 

26621= 

IF(IPSC)  68,67,72 

26630*  67 

IF ( IPSCT. EB. 2)  60  TO  72 

26641=  68 

YPR(1)=RNIN 

26651= 

DO  78  1=1, IPAPER 

26668=  78 

YPR 1 1+1 ) =YPR ( I ) +18. *SCAL 

26678* 

WRITE (NDEV, 12)  BLANK, (YPR(I), 1=1. IPRT1) 

26688= 

60  TO  108 

26698*  72 

DO  76  ISC=1,H 

26788* 

YPR(1)=YHIN(ISC) 

26718= 

DO  74  1=1, IPAPER 

26728=  74 

YPR(I+1)=YPR(I)*10.*YSCAL(ISC) 

26738=  76 

WRITEINDEV.12)  SYNBOL(ISC), (YPRIIX) f IX=1. IPRT1) 

26748=  188 

WRITE (NDEV, 1 ) 

26758= 

RETURN 

26768=C  END  SUBROUTINE  PLOTLP 

26778= 

END 

26788* 

SUBROUTINE  VARSCL (THIN, THAT , SCALE , RSPACE, I SCL ) 

26798= 

IF(XNAX.EQ.XNIN)  XHIN=.9*XHIN-10. 

26888= 

SCALE*XKAX-XNIN 

26818= 

IF < ISCL.EQ. 0)  60  TO  25 

26828* 

EXP=IFIX (188. +ALQ618 (SCALE) ) -188. 

26838= 

FACT0R=18.»*U.-EXP) 

26848* 

XHINT=XNIN»FACTOR 

26858= 

XHAXT=XHAX»F ACTOR 

26868* 

IF(XHAXT.6E.0.)  XHAXT=XHAXT+.9 

26878= 

IF ( XNINT. LE. 0. )  XRINT«XRINT-.9 

26888= 

XHINT=AINT(XHINT) 

26898= 

ISCAL*XNAXT-XHINT 

26988= 

IF (NOD (ISCAL. 5) .NE.0)  ISCAL*ISCAL+5-N0D(ISCAL,5) 

26918* 

FACT0R*18.«(EXP-1.) 

26928= 

XHIN=XHINTtF ACTOR 

26938= 

SCALE*FACTOR*FLOAT ( ISCAL) 

26948*  25 

SCALE*SCALE/RSPACE 

26958= 

RETURN 

26968*C  END  SUBROUTINE  VARSCl 

26978* 

END 

26988=C 

27800»C 


27818*C  CODE  FROM  THIS  POINT  ON  NAS  ADDED  BY  LT  HOSELEY  (1982) 

2782#=C 

27040-C 

27058* 

27068* 

SUBROUTINE  PFDATA(ICODE,ND) 

CONNON/NAIN1 /NDIN. NDIN1 , CONI ( 1 > 

27171* 

27081s 

27191* 

2718#* 

27111* 

27121* 

27131* 

27141* 

27158* 

27188* 

27178* 

27188* 

27190* 

27288* 

27210* 

27228* 

27238* 

27248* 

27258* 

27288* 

27270* 

27288* 

27298* 

27300* 

27318* 

27328* 

27338* 

27348* 

27350* 

27388* 

27370= 

27388* 

27390* 

27400* 

27410* 

27420= 

27430* 

27440* 

27450* 

27480* 

27470* 

27480* 

27490* 

27500* 

27510* 

27520* 

27530* 

27540* 

27550* 

27580* 

27570* 

27580* 

27590*  90 

27600* 


COHHON/HAIN2/COH2 ( 1 ) 

COHHON/ I NOU / K I N , KOUT , KPUNCH 

C0HN0N/DESI6N/NVC0N,  TSANP,  LFLRPI ,  LFLCGT,  IFLKF,  ITEVAL,  L  ABORT 
COHHON/F ILES7 KSAVE , KDATA , KPLOT , KL 1 ST , KTERH 
CONRON/SYSHTX/NVSH, SM ( 1 ) 

COMWOM/ ZNTX 1 /HVZM, ZH1 < 1 ) 

C0mt0N/ZHTX2/ZH2(l) 

COHHON/ND I  HO/M«Of  NftD  f  NPO ,  NHD,  NDD,  MHO  y  NHOO  f  NPLO ,  NMPNND ,  NNPR 
COHNON/LKD/LAP,L&,LPHIlLBD'LEX,LPHD,LB,LBN,LQDlLC,LDY)LEY,LHP,LR 
COHHON/DSHHTX/NVDN,  HOD  Y,  HOE  Y ,  DH  ( 1 ) 

COHHOH/HDIHC/NHC,HftC,NPC 
COHNOH/LOCC/LPHC, LBDC, LCC , LDC 
COHHON/CHDNTI/NVCN, HEHCH, HODC, CH ( 1 ) 

COHMM/NDINT/NNT,  NAT,  NHT,  NHT 

COHHOH/LOCT/LPHT,LBDT,LIM>T,LHT,LRT,LTDT,LTHT 

COHHON/TRUHTX/NVTH,TN(l) 

COHNON/LCNTRL/LPI 1 1 , LPI 12, LPI21 , LPI 22, LPHDL, LBDL 
COflHOH/COHTROL/HVCTL, CTL(l) 

C0WWH/LREBPI/L1DH,LUDH,LPHCL,LKX,LKZ 
COHHOH/CRE6PI/NVRPI , RPI ( 1) 

C0HH0N/LC6T/LA1 1 ,  LAI  3,  LA21 ,  LA23, LA12, LA22,  LKXA1 1 , LKXA12,  LKXA13 
C0HR0N/CC6T /HVC6T , CST ( 1 ) 

CONHON/LKF/LEADSN, LFLTRK, LFCOV 
CONHON/CKF/NVFLT,FLT(l) 

OIltENSION  HD(1) 

HD(1)*HHD 

HD(2)*HRD 

ND(3)=NPD 

ND(4)*NN0 

ND(5)*N8D 

NO(6)*HPLD 

HD(7)*HHC 

HD(8)*HRC 

HD(9)*HPC 

ND(i0)*wrr 

ND(11)*MT 

N0(12)*WT 

HD(13)*NODY 

ND(14)*H0EY 

NVZHS-NVZN 

CALL  FTHTX(DN(LPHI),SN,NND(NNO) 

LL*HHD#HHD+1 

CALL  FTNTX  (DU <LBD> , StKLL) , NND, NRO) 

LL*HHD»HRD+LL 

IF  (NOD.  EO.  0)  60  TO  1M 

CALL  FTNTX (DH(LEX) ,SH (LL) ,NND,HDD) 

LL*NND»NDD+LL 

CALL  FTNTX (DH4LPHD) f  SKILL) , HDD, NDD) 

LL*HDD*HDDH.L 
IF (NODY.EQ. 1)  80  TO  90 

CALL  FTNTX IDN(LDY), SHILL), NPD.NRD) 

LL*NP8*NRD+LL 
IFINOEY.EB. 1)  60  TO  95 

CALL  FTNTX (ON(LEY),SN(LL),NPD.NDD) 
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27611* 

LL*NPD»NDD+LL 

27621*  95 

CALL  FTHTX (DH (LHP) , SH ILL) , NHD, NPLD) 

& 

. 

27631* 

LL*NHD»NPLD+LL 

i 

27641* 

80  TO  2 #« 

27651*  Hi 

CONTINUE 

27661* 

IF(NODY.EO.l)  60  TO  185 

!•; 

2767#* 

CALL  FTHTXIDHILDY), SHILL), NPD,NRD) 

27681* 

LL*NPD»NRDH1 

Lj. 

2769#*  1#S 

CALL  FTHTX(8N(Ltf),SH(LL),NHD,M0> 

277##* 

LL*NHD*NND+LL 

f? 

2771#*  2ii 

CALL  FTHTX (DH(LC),SH ILL), NPD, UNO) 

K’ 

2772#* 

LL*NPD*NND+LL 

V 

2773#* 

CALL  FTHTXICHILPHC), SHILL), NNC,NNC) 

['“ 

2774#* 

LL=NNC*NNC+LL 

2775#* 

CALL  FTHTXICHILBDC), SHILL), NNC.NRC) 

2776#* 

LL*NNC»NRC*LL 

•4 

2777#* 

CALL  FTHTX(CHILCC),SN(LL),NPC,NNC) 

2778#* 

LL*NPC*NNC+LL 

!-; 

2779#* 

CALL  FTHTXITHILPHT), SHILL), NNT, NT) 

27881* 

LL*NNT*NNTHL 

£ 

2781#* 

CALL  FTHTX ITHILBDT), SHILL), NNT, NRT) 

1 

2782#* 

LL*HNT»NRT+LL 

[!• 

2783#* 

CALL  FTHTX (TH (LOOT), SH(LL),NNT,NNT) 

k 

2784#* 

LL*NNT«NNT*LL 

k; 

2785#* 

CALL  FTHTX(TH(LHT),SH(LL),NHT,NNT) 

r. 

2786#* 

LL»NHT*NNT+LL 

y 

0 

2787#* 

CALL  FTHTX  (THILRT) , SH(LL) , NHT, NHT) 

2788#- 

LL*NHT*NHT+LL 

A 

2789#* 

CALL  FTHTX(RPI(LKX),SH(LL),NR0,NN0) 

t. 

279##* 

LL*NR0»NND+LL 

-n 

27918* 

CALL  FTHTXIRPI (LKZ), SHILL), NRD, NPD) 

> 

2792#* 

LL=NRD*NPD+LL 

i 

2793#* 

CALL  FTHTX (C6T (LKXA1 1 ), SHILL) , NRC, NNC) 

1 

2794#* 

Ll*NRC«NNC+LL 

\- 

2795#* 

IF  (NOD.  EO.f)  60  TO  3## 

2796#= 

CALL  FTHTX (C6T(LKXA13), SHILL), NRD, NOD) 

■•: 

2797#* 

LL*NRD*NDD+LL 

2798#* 

CALL  FTHTX (FLTILFLTRK), SHILL), NPLD, NHD) 

Ci 

ki 

2799#* 

LL*NPLD*NHD+LL 

P 

28###* 

CALL  FTHTX (THILTOT), SHILL), HD, (HIT) 

28#U* 

LL*NND*NNT  Hi 

28028* 

CALL  FTHTX (THILTNT), SHILL), NOD, NNT) 

2883#* 

LL=NOD*NNTHi 

2884#* 

60  TO  31# 

'x» 

28«5i*  3i# 

CONTINUE 

P 

28#6#« 

CALL  FTHTX (FLTILFLTRK) , SHILL) ,NND,NHD) 

w* 

2887#* 

LL*NHO»NHDtLL 

.  • 

28(8#* 

CALL  FTHTX (THILTOT), SHILL), NND, NNT) 

r\ 

28i9i* 

LL*NND»NNT*LL 

:> 

281##*  31# 

SHILL) *TSAHP 

i 

2B11(* 

NO  I IS) *LL 

B 

«\7. 

2812#* 

CALL  NFILED(ICODE,LL,NO,SH) 

;>/ 

2813#* 

NVZH*NVZHS 

s 

2814#* 

RETURN 
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2815#*C  END  SUBROUTINE  PFDATA 

2816#-  END _ 

I  28171*  SUBROUTINE  IHPLEX(A)  I 

2818#*  COHHON/KAIN1 /NOIN. NDIK1 , COH1 ( 1 ) 

28191*  COHNON/DESISN/NVCOH, TSAHR, LFLRPI , Lf LOST, LFLKF, LTEVAL, LABORT 
282##*  CQHHON/FILES/KSAVE,  KOATA,  ((PLOT,  ((LIST,  KTERN 
2821#*  COHflON/SYSHTX/NVSN, SH ( 1 > 

2822#*  COffiNM/  ZNTI 1  /N  VZH,  ZHU 1 ) 

28231*  COHMN/NOIHD/NND,NRD,NPD,NHD,NDD,NND,NHDB,NPLB,NNPNNB,NNPR 
2824#*  C0HMM/L0CD/LAP,L6P,LPHI,LBD,LEX,LPHD,LB,LM,LBD,LC,U)Y,LEY,LHP,LR 
2823#*  COHMN/OSNHTX  /NVDH,  NODY ,  NOEY ,  ON  ( 1 ) 

2826#*  COHHON/NDIHC/NNC,NRC,NPC 
2827#*  CQHHON/ANC/ANU) 

2828#*  COHWOK/BD6/BD ( 1 ) 

2829#*  OINENSION  All) 

283##*  DATA  NO/1HN/ _ 

I  / - deletion - /  I 

2831#*  213  HRITE (KLIST, 126) 

2832#*  126  FORHAT (3<*»  M'COHBINED  IHPL1CIT/E1PLICIT  CONTROL'. 5(‘  «■)) _ 

|  / - delttion - - - /  I 

2833#*  Lfll*l 

2834#*  LRI1=L01+NPD*NPD 

2833#=  LRRI=LRII+NRD*NRD 

2836#=  NPONRD*NPDHMD 

2837#*  12#  CALL  ZPART (A, NPDNRD, NPDNRD, NPDNRD) 

2838#*  HRITE  122, NPD 

2839#*  122  FORHAT (*  ENTER  HEIGHTS  ON  IHPLICIT  OUTPUT  DERIVATIVES:  M2) 

284##*  CALL  RBN6TS(A,NPDr#> 

2841#*  HRITE  124, NRD 

2842#*  124  FORHAT (*  ENTER  HEIGHTS  ON  IHPLICIT  CONTROL  MAGNITUDES:  M2) 

2843#*  CALL  RBN6TS(A(LRII),NRD,1) 

2844#*  Ll=l 

2843#*  L2=L1+NND«NND 

2846#*  L3=L2+NPD*NND 

2847#*  L4*L3+NPD«NND 

2848#*  L5*L4+NPD*NND 

2849#*  L6*L5+NND*NPD 

283##*  L7=L6+NPD*NND 

2831#*  IF (NDD.EB.01  60  TO  5 

2832#*  NDIH*NPU> 

2833#*  NOIHl*NDIH+i 

2834#*  80  TO  1# 

2833#*  3  NOIH*NND 
2836#*  ND!Hl*NDIH+i 

2837#*  1#  CALL  TFRHTX (SH(Ll) , DHILAP) , NND, NND, 1 ) 

2838#*  CALL  FHflUL<DH(LC),SH(Ll),NPD,NND,NND,SH(L2>> 

2839#*  CALL  FHHUL(AH,DHILC),NPD,NPD,NND,SH(L3)) 

286##*  NDIH*NPD 

2861#*  NDIH1*NDIH+1 

2862#*  CALL  HADD1(NPD,NND,SH(L2),SH(L3),SH(L4),-1.) 

28638*  CALL  FTRNSP(NPD,NND,SH(L4),SH(L5)> 

2864#*  CALL  FHHU.(A,SH(L4),NPD,NPD,NND,SH(L6)> 

2865#*  CALL  FNHUL(SH(LS),SN(L6),NNO,NPB,NNO,SH<L1)) 

2866#*  CALL  FTRNSP(NND,NRD,B0,SN(L2)) 


i 

L* 

28671* 

CALL  FTRMSP  (NPD,  NND,  DR  <LC) , SM (L3) ) 

28681* 

CALL  FHHUL(SH<L2),SH<L3>,MD,NND,MPD,SH(L4)) 

28691* 

CALL  FHMUL(SMIL4) f SH(L6>  tNR0,NPD»NN0,SH(L5> ) 

1 

28781* 

CALL  FTHTI (SN(LS) , SH (L2) , NRD, NND) 

P 

28718* 

CALL  FNHUL ( SH (L4) , A, NROt NPD, NPD, SM (L5) > 

| 

28728* 

CALL  FNHUL(SH(L3),SM<LC),NRD,NPD,NND,SH(L6)) 

28738* 

CALL  FHMUL<SM(L6),8D,MD,NN0,NRB,SH(L7)) 

28748* 

CALL  HADD1(NRD,MD,A(LRII),SH(L7),SH(L5),1.) 

28758* 

CALL  FTNTI(SN(L3),SN(L3),NRD,NRD) 

28768* 

WRITE  488 

? 

28778*  4N 

FORMAT (*8LIST  BIH  MATRIX  TO  TERMINAL  (V  OR  N)  >‘) 

/* 

/. 

28781* 

READ  418, IANS 

e* 

28798*  418 

FORMAT (A3) 

•* 

• 

28888* 

IF(IANS.Efl.NO)  SO  TO  498 

28818* 

CALL  NATLST (SM1L1 ) , NND, NND, *QIH* , KTERH) 

■ 

28828* 

MITE  428 

H 

28838*  428 

FORMAT  C8CHANBE  IMPLICIT  WEIGHTS  (Y  OR  N)  >*) 

a 

28848* 

READ  418,  IANS 

28838* 

IF (IANS. EB. NO)  60  TO  498 

:ij 

28868* 

SO  TO  128 

a 

28878*  498 

CALL  NATLST (A. NPD. NPD. *0!*.KLIST) 

28888* 

CALL  DVCTOR(NPD,A,A(LRRI)) 

28898* 

CALL  NATLST (A (LRRI), NPD, l,*BIa, KTERH) 

V, 

ZotH* 

CALL  NATLST(A(LRII),MO,NRD,*Rr,KLIST) 

a 

28918* 

CALL  DVCTOR(MD,A(LRII),A(LRRD) 

£ 

28928* 

CALL  NATLST4A4LRRI), MO,  1,‘RI\ KTERH) 

V 

0 

28938* 

CALL  HATLST(SH<L1),NND,M(D,'BIH*,KLIST) 

28948* 

CALL  NATLST  (SM(L2) ,  NRD, NND,  ‘SW.KLIST) 

28938* 

CALL  NATLST(SH(L3),NR0,NRD,*RIH*,KLIST) 

28968* 

RETURN 

28978*C  END  SUBROUTINE  IMPLEX 

28988* 

END 

28998* 

SUBROUTINE  HODIFX(A) 

29888* 

COHMON/HAINl/NOIH,NDIHt,COH!(l) 

29818* 

COMHON/F ILES/KSAVE, KDAT A, KPLOT, KLIST , KTERH 

Si 

29828* 

COHMON/SYSHTI /NVSN,  SH  ( 1 ) 

,'w\ 

29838= 

COHHON/NDIHD/NND,  NRD,  NPD, NND,  NDD,  NND,  MOD,  NPLO.  NNPNND,  NNPR 

29848= 

COHHON/NDINC/NNC, NRC, NPC 

A 

29858* 

DIMENSION  A(l) 

P 

29868* 

Ll*l 

>; 

29878* 

L2*L1*NND#NND 

29888* 

L3*L2+MD«NND 

£: 

29898* 

L4*L3+MD*MD 

%  . 
v 

29188* 

L3*L4+NND*NND 

£ 

29118* 

L6*L5+NND#NND 

29128* 

NDIN*NNPR 

29138* 

NDIH1*NDIN+1 

29148* 

CALL  TFRHTI (SH(L4) , A,NND, NND, 1 ) 

29158* 

CALL  FNADD(SM(L4),SH,NND,NND,SN(L5)) 

'5y 

ai 

29168* 

CALL  TFRHTI (SH <L5) , A, NND , NND, 2 ) 

29178* 

LLL*LADDR ( NDI N , NND* 1 , 1 ) 

29188* 

CALL  TFRHTI (SN(L4),A(LLL), NRD, NN0,1) 

l-A 

■y:-: 

29198* 

CALL  FHADD(SN(L4),SM(L2),NRD,NND,SN(L5)) 

$ 

29288* 

CALL  TFRHTI ( SH (L5) , A (LLL) , NRD, NND, 2) 

Ov 

B 

D-64 

* 


29211= 

CALL  FTRNSP (NRD,NND,SN(L5),SH(L6)) 

29221= 

LLL=LADDR(NDIN,1, NND+1) 

29231= 

CALL  TFRNTX(SH(L6),A(LLL),NND,NR0,2) 

29241= 

LLL=LAODR (NDIH, NND+1 , NND+1 > 

29231= 

CALL  TFRHTI(SN(L4),A<LLL>,NRD,NRD,1) 

29261* 

CALL  FHADD(SN(L4),SH(L3),NRD,NRD,SN(L5)) 

29271= 

CALL  TFRNTX(SN(L3>,AU.LL),NR0,NRD,2) 

2928#= 

CALL  MTLST(A,NNPRINNPR,*1IEI,KLIST) 

2929#= 

RETURN 

293f#=C  END  SUBROUTINE  HODIFI 

2931#= 

END 

29321* 

SUBROUTINE  FTRNSP (NR, NC, A, B) 

2933#= 

OIHENSION  A(l), B(l) 

2934#= 

DO  1#  1=1, NR 

2935#= 

DO  2#  J=1,NC 

2936#= 

B ( ( I - 1 ) *NC+J ) =A ( 1 J - 1 ) #HR+ I ) 

29371*  2# 

CONTINUE 

2938#=  1# 

CONTINUE 

2939#= 

RETURN 

294##*C  END  SUBROUTINE  FTRNSP 

2941#= 

END 

D.5  CGTPIV  Segmentation  Job  Control 


CGTPIB  =  Binary  object  code 
CGTPIV  s  Executable  load  module 
DLKLIB  a  Library  routines  [16,23] 


1M*H6H.  T834283, HILLER 

llf=HAP,FULL. 

12#*ATTACH.C6TPIB. 

13#*ATTACH, DLKLI8, ID*TB2B3I3 

14#=LI8RARY,DLKLI8. 

15#«REBIJEST,CSTPIV,»PF. 

16f*SE6L0AD(B*CSTPIV> 

17f*L0AD(CSTPIB> 


t?f*RENIND,CSTPIV. 

2M*CATAL06,CBTPIV,CGTPIV,RP*18I. 

21»*«£0fi 

22f*SETU>  INCLUDE  DSCRT 

23f*SRESPI  INCLUDE  RBN6TS,HLINEB,SYHFCT 

24#*FLTRK  INCLUDE  RBNBTS, KFLTR, HLINEB, SYNFCT , INTE6 

2SB-STRTH  INCLUDE  DSCRTT, INTEG 

26#*SDSN  INCLUDE  BDSCRT 

27f*CEVAL  INCLUDE  PLOTLP , V ARSCL , RPLOTF , NPLOTF , STRPLT 

28#*FEVAL  INCLUDE  PLOTLP, VARSCL, RPLOTF, NPLOTF, STRPLT, DACOV 

29#»B1  TREE  SETUP- (SDSN,SCND,STRTH) 

3N*B2  TREE  PIHTX 

311*13  TREE  SRE6PI 

321*84  TREE  SC6T 

33f*BS  TREE  CEVAL 

341*86  TREE  FLTRK 

35f*B7  TREE  FEVAL 

36«*B8  TREE  PFDATA 

371* A  TREE  C6TXfl-<Bl,B2,83.B4,85.D6,87.B8) 

38f*R00T  TREE  NAIN-A 

394*  GLOBAL  HAINl,NAIN2,INOU. DESIGN, FILES, SYSHTX,Zf1TXl , ZHTI2, 

4M*,NDINDfLKD,DSM1TI,NDINC,L0CC,CNDNTX, MINT, LDCT.TRUHTX.LCNTRL, CONTROL 
41 •=, LREGPI , CRE6PI , LCGT, CCST ,LKF, CKF , ARC, BD6 


IW 
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E.  Discussion  of  Design  Software  Error 

E.1  Introduction 

After  the  designs  for  this  study  had  been  developed  and  analyzed 
and,  in  fact,  after  this  report  had  been  written,  an  error  was  found  in 
the  original  CGT/PI/KF  design  software.  This  error,  in  turn,  had 
become  a  part  of  the  program  version  (CGTPIV)  which  was  used  for  the 
designs  in  this  research.  The  impact  of  that  error  on  the  results  and 
conclusions  presented  in  this  report  was  evaluated  by  using  the  correc¬ 
ted  software  to  reaccomplish  a  cross-section  of  the  design  work.  While 
the  impact  was  assessed  to  be  significant,  it  did  not  invalidate  the 
main  findings  presented  in  this  thesis.  The  time  available  to  complete 
this  project  was  far  less  than  that  which  would  have  been  required  to 
reaccomplish  all  of  its  original  objectives  in  a  thorough  manner,  using 
the  corrected  software.  Under  the  circumstances,  it  was  felt  that 
documentation  of  the  error  and  its  impact,  within  this  report,  would  be 
more  practical  and  more  beneficial  than  attempting  to  rewrite  the 
report  in  its  entirety  without  adequate  data.  The  bulk  of  this  thesis 
was  therefore  left  intact,  in  order  to  avoid  discarding  the  good  (i.e., 
the  theoretical  development,  the  design  approach  and  the  use  of  analy¬ 
sis  tools)  with  the  bad  (primarily,  incorrect  observations  concerning 
the  type  and  extent  of  the  differences  between  designs  achievable 
through  the  standard  PI  regulator  design  method  as  compared  to  the 
implicit  model-following  formulation).  Clearly,  the  designs  presented 
in  Chapter  V  of  this  report  are  "good”  designs,  as  was  demonstrated  by 
performance  analysis.  Appropriate  gains  were  found  despite  the  soft¬ 
ware  error.  The  significance  of  the  error  was  that  it  made  the  design 


process  more  difficult,  and  restricted  the  choice  of  design  paths  which 
were  fruitful. 

This  appendix  discusses  the  error  that  was  found  and  its  impact  on 
the  designs  and  conclusions  presented  in  the  body  of  this  report.  Re¬ 
vised  insights  as  to  the  differences  between  the  standard  and  implicit 
model-following  regulator  formulations  are  provided.  A  few  sample 
regulator  designs  are  presented  to  demonstrate  the  use  of  the  corrected 
software.  These  designs  are  preliminary  in  nature,  and  have  not  been 
refined  to  the  extent  that  those  presented  in  Chapter  V  were.  They  do, 
however,  point  out  the  differences  observed  due  to  the  software  correc¬ 
tion  and  demonstrate  the  validity  of  the  work  previously  presented. 

E.2  The  Software  Error 

Appendix  A  reviewed  the  formulation  of  a  constant-gain,  LQ, 
optimal  PI  regulator,  and  related  the  development  to  the  CGT/PI/KF 
design  software.  In  using  that  software,  the  designer  specifies  a 
number  of  continuous-time  quadratic  weighting  factors  which  become  a 
part  of  a  cost  function  that  is  mathematically  minimized  to  determine 
the  optimal  gains  for  the  controller.  As  one  might  imagine,  a  great 
deal  of  mathematical  manipulation  takes  place  between  the  entry  of  the 
quadratic  weights  at  the  terminal  and  the  final  revelation  of  the 
desired  gains.  The  process  is  explained  in  detail  in  Volume  2  of  [16]. 
It  includes  discretization  of  the  continuous-time  cost  function,  trans¬ 
formation  to  remove  cross-weighting  terms  so  that  a  standard  Riccati 
equation  solver  can  be  used,  solution  of  the  matrix  Riccati  equation, 
and  retransformation  of  the  resulting  gains  for  use  in  the  original 
system  coordinates.  During  this  complex  process,  the  array  containing 


the  discretized  weighting  factors  for  the  control  rates  was  used,  in 
the  original  program,  as  the  input  argument  of  "GMINV,"  a  library 
subroutine  [231  which  calculates  a  matrix  inverse: 

10440s  CALL  GMINV (NRD, NRD,U,ZM1 ,MR, 1 ) 

The  above  line  of  code  calls  "GMINV"  to  find  the  inverse  (or  pseudo¬ 

inverse,  if  appropriate)  of  the  "NRD"  by  "NRD"  matrix  "U,"  returning 
the  result  as  matrix  "ZM1."  "MR"  is  the  calculated  rank  of  the 
inverse,  and  the  ”1"  is  an  input  flag  to  enable  the  printing  of  error 
messages.  The  matrix  "U"  is,  however,  destroyed  in  the  computation  of 
"ZM1."  In  the  original  program,  the  destroyed  matrix  was  inadvertently 
used  in  a  subsequent  calculation,  thus  producing  the  incorrect 
controller  gains. 

To  correct  the  problem,  line  10440,  above,  was  replaced  by 

10435s  CALL  EQUATE(PHIP,U,NRD,NRD) 

10440s  CALL  GMINV (NRD, NRD, PHIP,ZM1 ,MR, 1 ) 

The  first  line  calls  "EQUATE"  to  copy  the  "NRD"  by  "NRD"  matrix  "U" 
into  the  array  "PHIP."  "PHIP"  is  then  used  as  the  calling  argument  for 
"GMINV,"  thus  preserving  "U".  This  change  has  been  incorporated  into 
the  source  listing  given  in  Section  D.4,  and,  in  fact,  the  given  line 
reference  numbers  apply  to  that  listing. 

Because  of  the  complexity  of  the  calculations  just  described,  the 
error  was  well  disguised  to  the  novice  LQ  designer.  As  long  as  the 
values  of  the  weights  on  the  control  rates  were  kept  small  in  relation 
to  the  weights  placed  on  the  control  magnitudes  and  on  the  outputs  (or 
output  rates),  the  effect  of  the  invalid  matrix  on  the  computed  gain 


did  not  generally  prevent  iteratively  converging  on  a  design  with  good 
performance.  Several  erroneous  impressions  arose  early  in  the  study 
because  of  the  relationship  just  described.  Very  small  increases  in 
the  weights  on  the  control  rates  were  seen  to  be  effective  in  slowing 
down  the  initial  response  of  the  regulator  (which  was  an  objective  in 
the  design  due  to  the  rate-limited  actuators).  But  larger  increases 
(to  more  than  about  3,  given  the  values  of  the  other  weights  being  used 
at  the  time)  had  been  found  to  cause  overshoots  and  oscillations  in  the 
actuators  and  outputs.  Also,  only  a  limited  amount  of  regulator  speed 
control  had  been  readily  achievable  with  the  standard  regulator. 
Therefore,  the  extensive  further  efforts  at  slowing  the  regulator  were 
directed  to  the  design  path  using  implicit  model-following,  with 
various  regulator  command  models  and  varying  weights  on  the  output 
rates. 

The  locations  of  the  closed-loop  regulator  poles  were  calculated 
independently,  and  not  affected  by  the  error;  they  were  correct  for  the 
quadratic  weights  assigned  but,  unfortunately,  wrong  with  respect  to 
the  actual  gains  which  defined  the  controllers.  Thus,  the  prediction 
of  robustness  with  respect  to  higher-order  dynamics  models  in  Section 
5.6,  while  based  on  sound  theory  and,  in  fact,  effective  due  to  the 
relative  pole  locations  for  the  designs,  was  actually  conducted  on  the 
basis  of  the  wrong  absolute  pole  locations.  This  condition  gave  rise 
to  an  additional  misconception  —  that  the  use  of  implicit 
model-following  could  provide  much  greater  and  more  systematic  control 
over  the  locations  of  the  closed-loop  system  poles  than  could  the 
standard  formulation.  This  appeared  to  be  the  case  because  the 
erroneous  software  seemingly  allowed  a  greater  range  of  quadratic 


weights  to  be  placed  on  the  implicit  model-following  output  rates  than 
on  the  outputs  of  the  standard  regulator.  The  differences  in  the 
reported  pole  locations  were  greater  than  the  amount  of  change  actually 
occurring  in  the  true  system  poles  due  to  the  difference  in  gain. 

The  gains  that  were  calculated  were  incorrect  only  with  respect  to 
the  quadratic  weights  assigned  by  the  designer.  The  designs  produced 
were  valid,  since  the  controller  is  defined  by  its  gains  and  the 
control  law  in  which  the  gains  are  used.  The  gains  were  "good"  because 
they  were  shown  to  produce  good  performance  in  simulation  analysis. 

Very  similar  designs  were  achieved  with  the  corrected  software,  and 
simply  occurred  with  different  quadratic  weights,  which  were  the  result 
of  design  iteration. 


E.3  The  Impact  of  the  Error  on  the  Design  Results 

To  demonstrate  the  effect  of  the  correction  to  the  software  on  the 
design  process,  consider  the  baseline  standard  PI  regulator  (SR-B) 
discussed  in  Chapter  V.  The  quadratic  weights  used  in  conducting  the 
design  with  the  original  software  are  listed  in  Table  V-1 ,  as  are  the 
gains  calculated  by  the  program.  Using  the  same  quadratic  weights  with 
the  corrected  program  produced  the  following  regulator  gains: 


(E-la) 


-181.5 

36.97 

-6.79 

3.147 

0.3260 

124.8 

-153.2 

-4.25E-2 

0.3115 

1.795 

These  gains  differed  significantly  from  those  given  for  SR-B  in  Table 

V-1,  and  so  did  the  performance  of  the  controller.  The  reported 

closed-loop  pole  locations  were,  however,  the  same  as  given  for  SR-B  in 

Table  V-3.  Compared  to  that  of  SR-B,  summarized  in  Table  V-2  and  shown 

in  Figure  V-1,  the  transient  response  for  this  regulator  using  the 

linear  single-state  actuator  model  was  extremely  fast,  with  a  rise  time 

of  0.06  seconds,  but  with  better  damping  (an  overshoot  of  only  20%  in 

the  pitch  angle).  Accordingly,  the  horizontal  tail  and  trailing  edge 

flap  control  actuators  were  driven  to  well  over  twice  their  true 

position  limits  and  at  initial  rates  of  about  50  and  20  times  their 

respective  rate  limits  (given  in  Section  4.3).  Considering  the  poor 

results  with  much  slower  regulators  discussed  in  Chapter  V,  there  was 

not  much  point  in  simulating  the  performance  of  thi3  regulator  with  the 

nonlinear  actuator  model  which  included  rate  and  position  limits.  When 

the  regulator's  response  to  initial  conditions  was  evaluated  with 

respect  to  the  linear  three-  and  four-state  actuator  models,  the  design 

was  grossly  unstable,  with  state  magnitudes  reaching  values  on  the 
18 

order  of  10  within  2  seconds  of  the  start  of  the  simulation,  whereas 
SF-B  had  been  oscillatory,  but  stable,  under  the  same  conditions. 

By  decreasing  the  weights  on  the  outputs  (the  ”Ytt  matrix  of 
CGTPIV)  from  200  to  5  each,  the  value  of  X(3»3)  in  the  state  weighting 
matrix  from  50  to  2,  and  also  increasing  the  weights  on  the  control 
rates  (the  "UR"  matrix)  from  1  to  10  each,  a  design  with  gains  and 
performance  much  more  like  the  original  baseline  regulator  was 
achieved.  The  pole  locations  for  such  a  design  should,  therefore,  be 
reasonably  similar  to  the  true  pole  locations  for  SR-B.  For  the  design 
just  described,  the  poles  were  located  at: 


-13-6  ±  J15.5 
-1 .87  -  JO. 07 
-27.8 
-15.9 
-20.0 

which  were  considerably  different  from  the  erroneous  poles  listed  for 
SR-B  in  Table  V-3.  With  the  corrected  software,  the  values  of  the 
output  weightings  could  be  reduced  even  further  relative  to  the  input 
rate  weightings,  producing  designs  very  similar  to  those  achieved 
through  implicit  model-following  with  a  two  state  command  model;  it  is 
important  to  note  that  this  had  not  been  possible  with  the  uncorrected 
software.  At  the  same  time,  the  greater  range  of  changes  in  the 
quadratic  weightings  in  the  standard  regulator  designs  also  permitted 
systematic  control  of  the  location  of  the  closed-loop  regulator  poles, 
as  had  earlier  been  thought  possible  only  when  implicit  model-following 
was  employed.  Examples  of  these  observation  will  follow  in  the  next 
section. 

The  effect  on  the  design  process  with  implicit-model  following 
paralleled  that  Just  outlined  for  the  standard  regulator.  Use  of  the 
quadratic  weightings  of  the  designs  from  Chapter  V  resulted  in  high 
gains,  large  actuator  commands,  and  gross  instability  with  respect  to 
higher-order  dynamics.  Designs  with  gains  and  performance  characteris¬ 
tics  similar  to  those  evaluated  in  Chapter  V  where  achievable  through 
reduction  of  the  output  rate  weightings  (the  ”QI"  matrix  of  CGTPIV)  and 
by  increasing  the  weights  on  the  control  rates  (the  "UR”  matrix).  With 
the  corrected  software,  representing  the  actuator  states  as  outputs  of 
the  implicit  regulator  command  model  appeared  to  present  an  additional 
feasible  design  option;  the  excessive  initial  actuator  commands  which 


had  occurred  when  this  was  attempted  prior  to  the  software  change  were 
found  to  be  countered  by  using  increased  control  rate  weightings. 

In  both  standard  and  implicit  designs,  increasing  the  weight  on 
the  control  magnitudes  ("UM"  or  "RI"  matrices)  did  not  yield  a  reduc¬ 
tion  in  initial  control  surface  actuation;  it  generally  still  caused 
the  initial  control  inputs  to  be  increased,  as  had  been  observed  in 
Section  4.4.3* 

In  summary,  the  primary  impact  of  the  software  error  on  the  design 
results  of  this  study  was  as  follows: 

1 .  The  designs  presented  in  the  main  body  of  the  thesis  were 
valid,  as  were  the  analyses  conducted  using  simulation  and  singular 
values.  Achieving  the  designs  with  the  incorrect  software  resulted 
from  the  use  of  quadratic  weightings  which  would  have  been  inappro¬ 
priate  when  used  with  the  corrected  software.  The  quadratic  weightings 
used  in  the  research  were  the  result  of  a  systematic,  iterative  design 
process  which  would  have,  in  fact,  been  easier  had  the  design  software 
functioned  properly. 

2.  With  the  corrected  software,  the  standard  regulator  formula¬ 
tion  was  capable  of  producing  designs  similar  to  those  based  on 
implicit  model-following  with  a  two-state  command  model.  Use  of  the 
standard  formulation  still  required  designer  insight  for  the  manual 
alteration  of  the  (3,3)  element  of  the  state  weighting  matrix  ("X”)  to 
improve  the  output  damping  [16];  the  Implicit  model-following 
formulation  provided  the  proper  weighting  automatically  for  a  wide 
range  of  designs.  This,  in  fact,  was  the  primary  difference  between 
the  design  of  the  standard  regulator  versus  that  of  the  implicit 
regulator  based  on  the  two-state  command  model.  With  the  corrected 


software,  the  use  of  higher-order  regulator  command  models  still 
appeared  to  provide  a  relatively  greater  degree  of  designer  control 
over  some  aspects  of  the  design  characteristics;  specifically,  the  use 
of  a  three-state  command  model  allowed  the  regulator  to  be  slowed  to  a 
much  greater  extent  without  loss  of  proper  damping,  alleviating  the 
need  for  designer  insight  to  modify  the  structure  of  the  state 
weighting  matrix. 

3.  The  locations  for  the  closed-loop  regulator  poles  given  by  the 
erroneous  software  did  not  correspond  to  the  correct  locations  associa¬ 
ted  with  the  actual  controller  gains.  However,  the  relative  motion  of 
the  poles  given,  in  response  to  changes  in  the  quadratic  weightings, 
was  correct.  The  example  analyses  in  the  sequel  will  demonstrate  that 
the  use  of  the  correct  regulator  pole  locations  in  predicting  the 
robustness  of  the  designs  in  the  face  of  neglected  higher-order 
dynamics  provides  an  even  greater  degree  of  insight  than  had  been 
proposed  using  the  erroneous  absolute  pole  locations  in  Chapter  V. 

4.  The  calculation  of  the  CGT  gains  was  not  affected  by  the  error 
in  the  software,  nor  were  any  aspects  of  the  singular  value  robustness 
analysis  for  the  PI  regulator  designs. 

With  these  facts  in  mind,  the  reader  who  has  not  yet  conducted  an 
in-depth  coverage  of  Chapters  IV,  V  and  VI  is  encouraged  to  do  so  prior 
to  reading  the  next  section. 


Several  example  preliminary  designs  which  support  the  conclusions 
of  the  preceding  section  were  assembled  and  analyzed  in  a  manner 
similar  to  that  of  Chapter  V.  Time  was  not  available  to  explore  the 
possibilities  for  improving  on  these  initial  designs  by  further 
experimentation  with  quadratic  weights  or  different  regulator  command 
models,  but  the  designs  presented  do  provide  an  indication  of  the 
characteristics  of  the  designs  achievable  with  the  corrected  software, 
and  allow  the  analysis  methods  previously  applied  to  be  exercised  and 
validated.  From  this  point  on,  it  is  assumed  that  the  reader  is 
thoroughly  familiar  with  the  design  results  and  analysis  methodology  of 
Chapter  V.  The  presentation  here  is  brief,  and  the  analysis  results 
are  reviewed  only  in  enough  depth  to  characterize  the  performance  and 
robustness  of  the  "new"  designs.  Most  of  the  controllers  discussed  are 
very  similar  to  those  presented  in  the  main  body  of  this  thesis;  they 
were  simply  achieved  using  different  quadratic  weights.  Refer  to 
Tables  E-1  through  E-6  at  the  end  of  this  appendix.  These  tables 
present  data  in  a  format  similar  to  that  used  in  Chapter  V;  this  data 
will  be  used  to  summarize  the  controller  characteristics.  Time 
response  plots  are  not  included,  as  they  were  deemed  to  provide  little 
additional  information  or  insight.  The  names  given  the  new  regulators 
parallel  those  in  Chapter  V,  with  a  "C"  added  to  Indicate  "Corrected 
software."  CGT  designs  are  not  discussed,  as  the  CGT  gain  calculation, 
given  a  set  of  applicable  regulator  gains,  was  not  effected  by  the 
software  change. 

Designs  SR-1C  and  SR-2C  were  based  on  the  standard  PI  regulator 
formulation.  As  seen  in  Table  E-1,  lower  weights  on  the  outputs  and 


greater  weights  on  input  rates  were  used  than  had  been  employed  for  the 
standard  regulator  designs  of  Chapter  V  (referring  to  Table  V-1). 

SR-1C  exhibited  transient  performance  similar  to  that  of  SR-B  (Table 
V-2)  in  response  to  initial  conditions,  as  outlined  in  Table  E-3;  it 
was  slightly  faster,  as  characterized  by  rise  and  peak  times,  but  more 
heavily  damped.  The  initial  inputs  to  the  actuators  were  also  similar 
to  those  of  SR-B,  and  the  maximum  stable  initial  condition  with  respect 
to  the  nonlinear  actuators  was  therefore  nearly  the  same.  When  tested 
against  the  four-state  linear  actuators,  SR-1C  was  highly  unstable 
(output  values  on  the  order  of  10^  in  2  seconds),  whereas  SR-B  had  been 
stable,  but  oscillatory.  When  tested  at  the  .6  mach/20,000  feet  flight 
condition,  its  performance  was  similar  to  that  of  SR-B,  which  was  quite 
good.  The  minimum  singular  values  for  the  inverse  return  difference 
function  as  well  as  closed-loop  regulator  pole  locations  are  given  in 
Table  E-5,  and  will  be  referred  to  in  subsequent  comparisons. 

Design  SR-2C  was  based  on  even  lower  output  weights  and  higher 
input  rate  weights,  and  thus  provided  a  slower  transient  response  than 
the  previous  design;  similar,  in  fact,  to  the  IMF2  class  regulators  of 
Section  5.4.  Thus,  it  displayed  a  predictably  larger  tolerance  than 
did  SR-1C  for  Initial  conditions  using  nonlinear  actuators.  It  also 
performed  well  against  the  linear  four-state  actuator  model.  This 
might  have  been  predicted  by  its  relatively  larger  minimum  singular 
values  over  the  range  of  10  to  100  radians  per  second,  and  by  the 
location  of  the  complex  regulator  poles  —  closer  to  the  origin  and 
much  further  from  the  perturbing  actuator  poles.  Because  it  had  a 
larger  overall  minimum  singular  value  than  did  SR-1C,  its  somewhat 
worse  performance  at  .6  mach  and  20,000  feet  would  not  have  been 


predicted  by  singular  value  analysis. 

Referring  again  to  the  tables,  IMF2-1C  was  the  first  "new" 
implicit  model-follower,  with  performance  similar  to  that  of  the  old 
IMF2-1 •  Comparison  of  Tables  V-4  and  E-1  thus  provides  insight  as  to 
the  amount  of  adjustment  required  in  the  quadratic  weights  due  to  the 
software  change.  IMF2-1C's  stable,  but  oscillatory,  performance 
against  the  linear  four-state  actuator  model  could  have  been  predicted 
by  either  singular  value  or  pole-location  analysis,  in  comparison  to 
the  values  and  performance  of  the  standard  regulators  just  reviewed. 
Singular  value  analysis  once  again  would  have  provided  little  insight 
into  the  performance  of  IMF2-1C  at  .6  mach  and  20,000  feet;  its  minimum 
singular  value  was  about  the  same  as  that  of  SR-2C,  but  its  performance 
was  worse  than  that  of  either  of  the  two  previous  designs. 

IMF2-2C  was  based  on  a  slower  regulator  command  model  and  larger 
input  rate  weights,  partially  offset  by  larger  output  rate  weights  than 
in  the  previous  design.  These  weights  were  not  purposefully  chosen  by 
comparison  to  those  of  the  previous  design,  but  resulted  from  a  series 
of  iterations  about  a  different  design  point.  The  design  had  a  slower 
rise  time,  better  damping,  and  a  better  capability  with  respect  to 
nonlinear  (saturating)  actuators,  in  comparison  to  IMF2-1C.  Note,  from 
Table  E-5,  that  the  only  poles  that  moved  significantly  (compared  to 
IMF2-1C)  were  the  two  nearest  the  origin,  which  generally  track  the 
command  model  poles.  Since  the  complex  poles  did  not  move  appreciably, 
and  in  consideration  of  the  similarity  of  their  minimum  singular 
values,  it  is  not  surprising  that  the  performance  of  the  two  implicit 
model-followers  with  respect  to  the  higher-order  actuators  was  nearly 
the  same.  Again,  singular  value  analysis  provided  little  insight 


regarding  performance  at  .6  mach  and  20,000  feet. 

IMF2-3C  differed  from  the  previous  design  only  because  of  reduced 
weights  on  the  output  rates.  Its  rise  time  therefore  increased  and  so 
did  its  capability  with  regard  to  actuator  saturation.  Pole-location 
and  singular  value  analysis  would  have  predicted  the  nearly  identical 
performance  with  the  linear  four-state  actuators  to  that  of  SR-2C. 

Note,  in  fact,  that  all  of  the  entries  in  each  of  the  tables  are  nearly 
the  same  for  the  two  designs  —  including  the  regulator  gains.  Nearly 
identical  designs  were  produced  with  the  two  different  regulator  design 
formulations;  the  primary  difference  between  the  two  methods,  so  far  as 
the  designer  is  concerned,  would  have  been  the  insight  required  to 
modify  the  (3*3)  element  of  the  standard  formulation's  "X”  matrix  to 
provide  the  same  damping  as  that  provided  automatically  by  the  implicit 
formulation  (the  actual  value  of  Xgg(3,3)  in  the  combined  state 
weighting  matrices  for  both  designs  was  precisely  1.0). 

IMF3-1C  used  the  "slow"  three-state  regulator  command  model.  As 
was  the  case  with  the  IMF3  designs  of  Section  5.5,  this  resulted  in 
very  slow  transient  response,  but  very  good  damping.  However,  the 
capability  with  respect  to  actuator  saturation  was  less  than  might  have 
been  expected  for  such  a  slow  regulator,  and  additional  iterations 
would  have  been  necessary  to  resolve  that  problem.  A  more  serious 
problem  with  the  design  was  the  vulnerable  position  of  its  complex 
poles  which,  in  conjunction  with  the  poor  singular  values  shown  in 
Table  E-6,  adequately  predicted  that  the  controller  would  be  unstable 
when  tested  with  the  linear  four-state  actuators.  As  usual,  singular 
value  analysis  would  not  have  predicted  this  controller's  relatively 
good  performance  at  .6  mach  and  20,000  feet. 


IMF3-2C  was  designed  with  the  specific  goal  of  "safely"  placing 
the  complex  regulator  poles.  The  faster  command  model  was  used,  since 
it  had  been  observed  to  affect  primarily  only  the  poles  nearest  the 
origin  on  the  real  axis,  so  as  to  avoid  slowing  the  transient  response 
unnecessarily.  As  shown  in  Table  E -2,  however,  radical  adjustments 
were  made  in  the  output  rate  and  input  rate  weightings  to  drive  the 
complex  poles  toward  the  origin.  The  effort  was  successful,  as  shown 
in  Table  E-6;  both  pole  locations  and  singular  values  predicted  the 
excellent  performance  achieved  with  the  four  state  actuators.  Although 
probably  somewhat  slow  for  use  in  a  fighter  flight  control  system 
(indicating  the  need  for  additional  design  iteration),  this  regulator 
was  also  capable  of  handling  a  7  degree  initial  condition  with 
nonlinear  actuators  and  performed  reasonably  well  at  .6  mach  and  20,000 
feet.  Although  the  results  are  not  shown  in  any  of  the  tables,  a 
hybrid  CGT/PI  using  this  regulator  in  conjunction  with  the  CGT  gains  of 
IMF2-5  also  provided  reasonably  good  performance  in  following  a  step 
command  input. 

The  final  design  shown  in  the  tables  was  somewhat  experimental.  A 
four-state  regulator  command  model  was  used,  with  outputs  to  be  tracked 
by  the  pitch  angle,  flight  path  angle,  and  the  two  actuator  states. 

This  had  been  tried  with  the  uncorrected  software  and,  although  the 
rise  time  had  been  slow,  the  Initial  commands  to  the  actuators  had 
always  been  excessive  due  to  the  distribution  of  weights  in  the  "RIH" 
matrix,  as  discussed  in  Section  4.4.3*  With  the  corrected  software, 
this  problem  was  overcome  by  the  small  output  rate  weightings  and  the 
large  input  rate  weightings,  producing  a  transient  response  similar  to 
that  achieved  by  earlier  IMF3  designs.  Note,  in  Table  E-6,  the  pole 


location  givan  at  -254.4  -J157.1;  this  la  the  condition  noted  in 
Section  4.4.5,  wherein  a  pole  liea  on  the  negative  real  axis  of  the 
z-plane  and  cannot  correctly  be  mapped  into  the  s-plane.  The  value 
157*1  is  pi  times  the  controller  sampling  rate.  The  effect  of  this 
pole  on  the  controller  characteristics  was  not  known  until  it  was 
tested  against  the  linear  four-atate  actuator  model  and  found  to  be 
highly  unstable,  with  output  magnitudes  on  the  order  of  10^  after  2 
seconds.  Again,  this  would  have  been  predicted  by  the  small  high 
frequency  singular  values  for  the  controller.  On  the  other  hand,  the 
large  overall  minimum  singular  value  for  this  design  predicted  possible 
good  robustness  features  with  respect  to  parameter  variations.  When 
evaluated  at  .6  mach  and  20,000  feet,  IMF4-1C  exhibited  a  much  slower 
rise  time  (0.72  seconds)  than  at  design  conditions  and  very  low 
frequency  oscillations,  with  an  apparent  settling  time  of  about  3 
seconds.  This  change  in  response  rate  was  unique  among  all  of  the 
designs  presented.  Although  not  without  problems,  the  design  has  some 
interesting  characteristics,  and  merits  further  research.  Very  little 
work  was  done  in  this  study  with  such  a  four-state  command  model  due  to 
problems  generated  by  the  design  software  error.  The  analysis  of  this 
design  was  presented  only  to  show  that  the  correction  of  the  software 
provided  even  more  avenues  for  exploration  regarding  implicit 
model-following  design. 


This  appendix  documented  the  error  discovered  in  the  design 
software  subsequent  to  the  completion  of  the  research  work  presented  in 
the  rest  of  this  report*  The  primary  direct  impact  of  the  error  on  the 
validity  of  the  results  presented  in  this  thesis  was  shown  to  be  the 
incorrect  correlation  between  the  values  used  for  design  quadratic 
weights  and  the  gains  of  the  PI  regulators.  A  lack  of  correspondence 
also  occurred  between  the  given  closed-loop  regulator  pole  locations 
and  the  calculated  gains.  The  two  effects  combined  to  produce  miscon¬ 
ceptions  about  the  design  process  and  appropriate  design  strategies. 

The  limitations  imposed  by  the  error  resulted  in  a  large  portion  of  the 
design  effort  being  directed  at  finding  ways  to  control  the  speed  of 
the  initial  regulator  response. 

With  the  corrected  software,  the  speed  of  the  regulator  response 
could  be  controlled  effectively  by  changing  the  relative  values  of  the 
output  (or  output  rate)  weightings  and  those  of  the  control  rates. 

Uith  the  standard  regulator  formulation,  the  designer  was  required  to 
modify  the  structure  of  the  state  weighting  matrix  to  increase  the 
response  damping.  This  was  not  required,  when  using  implicit 
model-following  with  a  two-state  command  model,  until  the  weights  on 
the  control  rates  exceeded  those  on  the  output  rates  by  several  orders 
of  magnitude.  When  good  damping  was  required  with  even  slower 
response,  it  could  easily  be  achieved  through  the  use  of  the 
three-state  command  model. 

If  the  design  problem  discussed  in  this  report  were  to  be  recon¬ 
sidered  in  the  light  of  the  above  insights,  an  appropriate  design 
approach  using  the  corrected  software  would  be  similar  to  the  one  that 


was  followed  in  this  study.  With  the  software  providing  more  logical 
and  predictable  results  due  to  the  correction,  the  design  process 
should  produce  the  desired  performance  with  fewer  iterations.  The 
systematic  design  process,  using  implicit  model-following,  could  be 
summarized  as  follows: 

1.  Develop  alternative  regulator  designs  of  the  IMF2  and  IMF3 
(and,  perhaps,  IMF4  and  IMF5)  classes,  basing  the  initial  design 
iterations  on  the  need  to  achieve  adequate  transient  response  to 
initial  conditions  despite  the  nonlinear  (saturating)  actuators.  The 
primary  means  of  reducing  the  speed  of  the  initial  response  of  the 
regulator  would  be  by  increasing  the  magnitude  of  the  weights  on  the 
control  rates  (the  "UR”  matrix)  relative  to  the  magnitude  of  the 
weights  on  the  output  rates  (the  "QI"  matrix).  Since  only  the  relative 
sizes  of  the  various  weights  are  of  significance,  the  simplest  policy 
would  be  to  keep  the  weights  on  the  control  magnitudes  (the  "RI" 
matrix)  constant,  such  as  an  identity  matrix,  and  vary  only  "UR”  and 
"QI."  Designs  based  on  several  different  regulator  command  models  of 
each  class  should  be  included  to  provide  a  variety  of  different 
cloaed-loop  characteristics  for  further  analysis. 

2.  Analyze  the  alternative  designs  with  respect  to  higher-order 
actuator  dynamics  models.  Use  pole-location  and  singular  value 
analysis  in  conjunction  with  simulation  results  to  identify  favorable 
robustness  trends  that  result  from  varied  quadratic  weighting  and 
command  model  combinations. 

3.  Test  the  designs  which  perform  adequately  with  both  nonlinear 
and  higher-order  actuator  dynamics  models  for  robustness  with  respect 
to  parameter  variations,  through  simulation  with  perturbed  dynamics 


models 


4.  Design  CGT/PI  controllers  based  on  the  regulators  which,  in 
the  light  of  the  previous  tests,  are  best  suited  for  implementation. 
For  regulators  based  on  command  models  of  dimension  greater  than  the 
number  of  control  inputs  (2  in  this  case),  the  use  of  a  hybrid  CGT/PI 
(as  discussed  in  Section  5.5)  would  probably  be  required.  This  is  due 
to  the  inadequacy  of  the  CGT  design  formulation  when  faced  with  a  rank 
defective  n  matrix,  as  discussed  in  Section  4.4.7*  Analyze  the  CGT/PI 
designs  for  acceptable  tracking  of  command  inputs,  and  to  ensure  that 
the  CGT  control  inputs  do  not  destablize  the  overall  system  when 
operating  on  nonlinear  (saturating)  actuators. 

5.  At  any  point  in  this  process,  trend  information  that  arises 
from  the  analysis  results  can  be  used  to  "retune"  a  regulator  design, 
or  series  of  designs,  in  an  effort  to  improve  controller  performance. 
In  the  final  implementation,  the  use  of  anti-windup  compensation,  as 
discussed  in  Section  5.7,  should  be  considered  as  a  means  of  enhancing 
stability  characteristics  without  unnecessarily  degrading  performance. 

The  validity  of  the  design  approach  and  use  of  analysis  tools 
presented  in  the  body  of  this  report  was  not  adversely  affected  by  the 
software  error.  The  same  approach  and  tools  worked  Just  as  well,  if 
not  better,  with  the  initial  designs  based  on  the  corrected  software. 
Had  this  study  been  conducted  using  the  corrected  software,  a  great 
deal  more  about  the  true  capabilities  and  characteristics  of  implicit 
model-following  might  have  been  learned;  it  now  remains  a  topic  for 
future  research.  However,  except  as  already  noted,  the  conclusions 
reached  in  this  research  effort  remain  basically  unchanged. 


Definition  of  New  Sample  Designs 


Regulator  Gains 


6“ 

OO  V- 

on  =r 

^  «“ 

<-  oo 

cm  »o 

a  a 

ON  ON 

6- 

O  v- 

on  jo- 

•  a 

•  • 

o  o 

| 

i 

a-  ON 

oo 

on  -=r 

t-  oo 

oo  O' 

a  a 

vO  OO 

i-  m 

O'  6- 

cn  o 

on  ar 

jt  in 

•  • 

oo  oo 

•  a 

•  • 

o 

63 

*-  in 

1 

6Cl 

■ 

O'  O' 

«  a  ■  »/  'a® 

m  vo 

oo  O' 

t-  m 

t- 

m  in 

OO  CM 

CM  • 

t*-  in  | 

•  • 

a  a 

on  cm 

CM  O 

Hi 

i  i 

HI 

a  i 

in  vo 

oo  oo 

VO  O' 

^  «- 

in 

oo  in 

00  sr 

f~  CM 

^  -3* 

on  o 

c\  j  .=r 

o  »- 

*-  in 

CM  O' 

*-  in 

m  a 

•  • 

•  • 

a  a 

•  on 

o  o 

o  o 

o 

n 

oo 

c 

vO 

C*—  ON 

oo  oo 

00  «- 

O  *“ 

<9 

in  «■ 

O  vo 

in  on 

o 

r-  r- 

a 

a  a 

•  a 

^  a 

a-  o 

£. 

O 

•“  o 

© 

CO 

o> 

c- 

V-  O' 

(VI 

VO  O' 

00  O' 

C—  O' 

3 

in  i 

vO  vO 

in  t~- 

O  CM 

taO 

-=r  cd 

O  00 

•  iT 

in  o- 

0) 

•  cm 

•  • 

a—  a 

a  a 

os 

9  O 

1  o 

on  o 

1  00 

1 

vo 

CM  «- 

.=r  vo 

oo  O' 

a  a 

ON 

o  • 

•  • 

o  — 

•  on 

VO  v- 

O  O' 

«-  -=r 

o  • 

X 

•  ^ 

CM  6- 

i 

«-  CM 

6-Sl 

CTV  1 

1 

1  1 

CM 

CM  CM 

CM  1 

oo  on 

1  1 

1  Cd 

O'  O' 

oo  m 

Cd  Cd 

Ed  in 

cm  on 

•  • 

*-  in 

in  oo 

• 

«-  oo 

•  • 

a  a 

a-  a 

cm  on 

6-  in 

CM  CM 

»-  CM 

i 

i 

1 

1  1 

t 

3 

3  r-l 

o 

o  o  in 

o  o  o  o 

co  © 

in  in  •— 

^  ^  ^ 

«-  «-  CM  CM 

B  T3 

CM 

II  II  II 

II  II  II 

II  II  II  II 

a  o 

II 

HNcn 

viNcn 

•i-i  cm  rv-3- 

o  i 

Q. 

Ok  &4  0l» 

flU  0k  Pk 

0k  0*  flk  CU 

u 

o 

**■% 

O 

*"■  « 

© 

o  o 

.  /-»  o 

•  <M 

a  ^  ^ 

N 

o  ^  • 

a  a 

*"  *  % 

o 

O 

•  f-  O 

*-  «-  o 

•  *-  o 

•h  n 

CM 

a  •  ^ 

•  »  CM 

%  ® 

4->  4J 

f"  a 

in  v-  * 

•  a 

<P"  ^  a 

(0  J3 

*  *  © 

«  %  © 

«-  *  o 

%  ®  o  j 

C  60 

«-  «-  CM 

in  *-  «- 

•  —  CM 

»“  *" 

T9  *H 

w  w  w 

N— W 

w  w  w 

w  w  w 

to  © 

60  60  60 

at  60  oo 

60  60  60 

60  60  60 

3  31 

*0  <0  <0 

sQ  co  (d 

O' 

•H  *H  *H 

•H  *H  *H 

■O  T3  -O 

T3  T3  T3 

T3  T3  T3 

"O  TJ  T3 

II  II  II 

II  II  II 

II  II  II 

II  II  II 

HH  K 

HH« 

M  M  ft3 

H  H  (C 

C3106|=»T 

olosIcoT 

©Insl©” 

oi«i  =T 

U 

u 

u 

© 

c 

on 

CM 

a™ 

60 

i 

1 

1 

1 

•H 

CM 

on 

on 

& 

n 

£ 

fc 

ft 

5 

w 

w 

w 

M 

E-PO 


Summary  of  Performance  Analysis  for  New  Sample  Designs 


*Truth  model  is  otherwise  identical  to  linear  design  model 
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